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I.  INTRODUCTION 


Since  they  are  operated  in  three  dimensions  and  because  of  their  different  body 
structure  and  operational  conditions,  submarines  always  present  a  great  challange  for 
automatic  control  engineers.  Especially  lor  submarines  with  extremely  high  underwater 
speeds,  it  is  very  important  to  have  automatic  controls  which  can  be  used  effectively. 

In  this  study,  using  the  equations  of  motions  in  six  degrees  of  freedom  which  were 
developed  by  Naval  Ship  Research  and  Development  Center  (NSRDC),  a  linearized 
submarine  model  was  derived  for  both  horizontal  and  vertical  motions.  It  was  obvious 
that  working  with  a  linear  model  is  much  simpler  then  with  a  complete  nonlinear  model. 
Also  the  automatic  control  system  design  procedures  which  are  used  in  this  study  require 
a  linear  model  for  decoupling.  Even  though  the  linearized  model  does  not  introduce  a 
cross-coupling  effect  between  horizontal  and  vertical  motion,  as  would  a  real  submarine, 
it  works  in  almost  the  same  way  the  nonlinear  model  does. 

In  designing  an  automatic  controller  for  both  vertical  and  horizontal  motions,  a 
Ml  MO  (  Multi-input  Multi-output  )  system  representing  the  submarine,  has  to  be  in¬ 
vestigated.  Inputs  are  propeller  which  creates  the  forward  speed,  rudder  for  horizontal 
motion,  and  the  bow  and  stern  planes  for  vertical  motion.  The  outputs  are  the  three 
speed  components  u,  w,  v  and  roll,  yaw,  pitch  angles  around  three  axes  of  the  submarine. 
Also  a  ballast  system  can  be  used  to  maneuver  the  submarine  but  it  is  not  included  in 
this  study  assuming  the  submarine  is  always  in  trim. 

The  pitch  and  yaw  angles  and  the  depth  have  the  main  importance  for  maneuvering 
a  submerged  submarine.  Therefore  the  automatic  control  system  is  designed  to  control 
these  three  states. 

After  obtaining  valid  linear  models  for  both  horizontal  and  vertical  motions,  the 
method  of  the  automatic  control  design  has  to  be  chosen.  One  of  the  most  popular  de¬ 
sign  method  is  optimal  control  theory  but  it  requires  feedback  of  both  position  and  rate 
information.  This  information  is  available  for  submarines  which  are  equipped  with  an 
inertial  guidance  system.  For  the  small  coastal  submarines  which  do  not  have  an  inertial 
guidance  system,  a  different  design  approach  must  be  carried  out.  A  possible  way  would 
be  the  design  of  cascaded  compensators  using  only  position  (  such  as  depth  )  feedback. 

There  is  always  a  cross-coupling  effect  between  vertical  and  horizontal  motion  in  a 
submerged  submarine  which  is  also  called  a  squatting  effect.  The  cross-coupling  effect 
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is  simply  the  rudder  effect  on  vertical  plane  which  makes  the  submarine  pitch  up  and 
change  depth  when  a  rudder  angle  is  applied.  The  cross-coupling  effect  is  also  investi¬ 
gated  in  this  study. 


II.  EQUATIONS  OF  MOTIONS  IN  SIX  DEGREES  OF  FREEDOM 


A.  BACKGROUND 

With  diving  capability,  submarines  differ  from  surface  ships.  They  also  have  com¬ 
pletely  different  hull  structures,  hydrodynamic  specifications  and  relatively  complex 
control  and  stability  problems.  A  submarine  can  be  operated  in  all  six  degrees  of  free¬ 
dom.  To  maneuver  usually  three  sets  of  plane  surfaces,  the  propulsion  system  consisting 
of  one  or  two  propellers,  and  a  ballast  system  consisting  of  two  or  three  ballast  tanks  for 
different  type  of  submarines  are  used. 

To  control  horizontal  motion  the  submarine  has  a  usual  rudder  such  as  surface  ships 
do.  But  in  vertical  motion,  a  submerged  submarine  needs  at  least  one  more  control  sur¬ 
face  to  maintain  the  desired  depth  and  pitch  angle. A  classic  submarine  has  bow  planes, 
which  can  be  used  to  keep  ordered  depth,  and  stern  planes,  which  can  be  used  to  tilt  the 
submarine  to  an  ordered  pitch  angle.  Depending  on  the  submarines’s  speed  and  condi¬ 
tion  these  planes  can  have  an  appreciable  interaction. 

Modern  submarines  usually  have  bow  planes  on  their  sails,  which  are  called 
fairwatcr  planes.  However,  high  underwater  speeds  reduce  the  necessity  of  bowplanes. 
It  is  possible  to  keep  ordered  depth  without  using  bow  planes  while  operating  with 
higher  underwater  speeds.  Since  the  numbers  presented  by  XSRDC  [Ref.  1:  p.  88]  are  for 
an  American  submarine,  bow  and  fairwatcr  planes  were  both  considered  in  this  study. 

An  illustrative  picture  of  a  submarine  with  axes,  velocity  and  plane  definitions  is 
given  in  Fig.  1 .  The  arrows  are  pointed  in  the  positive  motion  direction. This  coordinate 
system  is  the  right  hand  orthogonal  system  which  is  fixed  in  the  submarine  and  moves 
with  it.  The  origin  of  the  coordinates  is  located  at  the  center  of  gravity  with  x-axis  along 
the  center  plane.  The  positive  x  direction  is  forward,  the  positive  y  direction  is  horizon¬ 
tally  to  the  right,  and  the  positive  z  direction  is  down.  [Ref.  2:  p.  43S] 

The  heading  of  the  submarine  is  the  direction  of  its  x-axis,  and  this  is  measured  as 
an  angle  with  respect  to  the  geographic  coordinate  system.  The  heading  angle,  also 
called  the  yaw  angle,  is  defined  to  be  the  angle  between  the  direction  of  the  ships  x-axis 
and  the  direction  of  the  x-axis  of  the  geographic  coordinate  system.  The  symbol  used  for 
the  yaw  angle  is  ip. 
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Figure  1.  A  Submarine  with  Axes  of  Motion 
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The  pitch  angle  of  the  ship  is  the  rotation  around  its  y-axis.  It  is  defined  to  be  the 
angle  between  the  direction  of  the  ships  x-axis  and  the  horizontal  reference  line.  The 
symbol  used  for  the  yaw  angle  is  6  . 

The  roll  angle  of  the  submarine  is  the  rotation  around  its  x-axis.  It  is  measured  from 
the  vertical  reference  to  the  direction  of  the  submarine  z-axis.  The  symbol  used  for  the 
roll  angle  is  <f>. 

Velocities  for  the  x,  v  and  z  directions  are  u,  v  and  w  respectively,  which  can  be 
called  velocity  components  oflinear  velocity  of  body  axes  relative  to  an  earth-fixed  axis 
system. 

Definitions  for  all  symbols  used  in  this  study  are  given  in  Appendix  A. 

B.  DERIVATION  OF  THE  LINEARIZED  MODEL 

The  equations  of  motion  arc  derived  by  summing  the  applicable  forces  and  moments 
in  each  degree  of  freedom:  surgc(x),  sway(y),  heave(z),  roll(0),  pitch(O)  and  yaw(^). 
Reference  1  presents  the  standard  sets  of  equations  of  motion  developed  for  submarine 
motion  studies  by  NSRDC.  These  equations  are  general  enough  to  simulate  the  trajec¬ 
tories  and  responses  of  submarines  in  the  six  degrees  cf  freedom  resulting  from  various 
types  of  maneuvers.  They  simulate  motion  of  a  given  ship  design  upon  insertion  of  the 
nondimensionalizeu  hydrodynamic  cocllicicnts  developed  for  that  particular  design.  In 
addition  values  must  be  supplied  for  propulsion  force  and  rudder  and  diving  plane  an¬ 
gles.  A  complete  set  of  hydrodynamic  coefficients  and  other  required  data  used  in  this 
thesis  is  given  on  Appendix  B. 

The  derivation  of  equations  of  motions  in  six  degrees  of  freedom  which  are  to  be 
linearized,  was  discussed  in  several  earlier  studies.  [Ref.  3  ,  Ref.  4  .]  The  authors  were 
satisfied  that  these  equations  are  valid  and  can  simulate  a  submarine's  motion  effec¬ 
tively. 

1.  Assumptions 

Forward  speed  can  be  taken  as  constant.  Linearizing  about  the  axial  speed, u, 
which  allects  nearly  every  term  in  the  standard  equations,  could  be  very  complex,  so  the 
forward  speed  was  assumed  to  be  constant.  This  also  reduces  the  degrees  of  freedom  to 
five. 

Roil  angle  is  assumed  to  be  small.  Under  normal  circumtances  in  submarine 
maneuvering,  the  roll  angle  usually  stays  within  ±5°.  Large  roll  angles  arc  only  caused 
by  high  speed  plus  hard  over  rudder.  Therefore,  the  roll  angle  can  be  neglected. 
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Cross-products  of  inertia  can  be  neglected.  This  assumption  is  common  to  all 
submarine  simulations  because  the  hull  and  interior  layout  of  submarines  is  approxi¬ 
mately  symmetric. 

All  terms  including  IV,  can  be  discarded.  Since  it  is  assumed  that  the  submarine 
is  in  trim,  weight  of  water  blown  from  a  particular  ballast  tank,  W, t  must  equal  zero. 

A 11  terms  involving  nonlinearity  are  neglected. 

Vertical  motion  is  decoupled  from  horizontal  motion.  As  a  result  of  the  first  five 
assumptions  it  also  has  to  be  assumed  that  there  is  no  coupling  between  vertical  and 
horizontal  motion. 

2,  Derivation  of  the  linear  equations  of  Motion 
a.  Linearization  on  the  vertical  plane 

The  linearized  form  of  the  equations  on  vertical  plane  are: 

1)  Equation  of  Motion  Along  z-axis  (Normal  Force): 

nriv  -  umq  =  y  Z4 Zqq  4-  y  /3(Z*u>  +  Zquq)  +  —  l\Zwuw  4-  u2(ZdsSs  +  Z6t)Sb ))  (1) 

where 

p  =  2.0  ~J~T  1  nlass  density  °i  sea  water, 

/  =  415  J't.  ,  submarine  length,  and 
m  =  6.25*10*  slugs  ,  submarine  weight. 

All  values  for  the  hydrodynamic  coefficients  are  given  in  Appendix  B. 
Substituting  these  numbers  into  the  equation,  and  after  performing  the  required  algebra 

iv  =  _5.l  \q  —  1.632.vIU“3i/iv  -4-0.261  — 7.416*10"’4u2<5.s  —  SJljdO-4!/2^  (2) 

2)  Equation  of  Motion  About  v-axis: 

Iyq  =  y  i\\lqq  4-  y  ?{Mquq  +  M+w)  +  y  l\Mwuw  +  u\MdsSs  +  Xi6bSb))  4-  Bzb6  (3) 

After  substituting  appropriate  numbers  and  required  algebra 

q  _  -4.975.xl0"\v  -6.219*10"3m(7  4-l.798*l0-5mv  -1.5*10~V<5s  4-  3.0*10~V<5& 

,  (4) 

4-2.516.vlO  3e  v  ' 

If  these  two  equations  are  substituted  into  each  other 
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vi>  -  0.294u?  -1.728*10"3ww  -6.667* 10"V<$s  -3.873jtIO ~*u2db  -C.01280  (5) 


q  =  1.884xlO"suw  -6.365*10"3m?  -1.465*10~V<$5  +3.193*10~V<5J>  +2.522*1O‘30(6) 

These  two  equations  describe  the  state  variable  representation  of  the 
linearized,  vertical  plane  equations  of  motion.  However  they  do  not  have  the  depth  as 
a  state  variable.  In  order  to  make  the  depth  a  state  variable,  these  equations  are  to  be 
modified  by  using  linearized  auxilary  equations  which  are  given  in  Appendix  C.  There¬ 
fore  the  auxilary  equation  used  for  the  modification  is 
i0  =  —uSind  +  vCosQ  sin  <t>  +  w  cos  6  cos  <f> 

Using  our  assumptions  the  linearized  equation  will  be 
z0  =  —uB  +  w 

Then  the  modified  linear  equations  of  motion  have  the  following  form 

z  «  —  1.728*10~3mz  -0.706m?  +  (0.012S3  -1.728*1O~V)0  -6.667*  10"V<5s 
-3.8 73*10"V<56 

q  -  1.884*10"smz  -6.365*10~3m?  -1.465*10"  Via  +  3.193*10'V<56 
+  ( L 884*  10~V -2.522*  1O~3)0 

As  it  was  mentioned  before  the  forward  speed  u  is  not  a  state  variable  but 
a  constant  which  can  be  changed  as  desired.  A  complete  block  diagram  for  vertical  mo¬ 
tion  is  given  in  Figure  2. 

b.  Linearization  on  the  Horizontal  Plane 

The  linearized  form  of  the  equations  on  horizontal  plane  are: 

1)  Uquation  of  motion  along  y-axis  (Lateral  Force): 

niv  -  mur  =  —  }>'  +  +  y  l3(  1>  +  Yrur  +  Ypup) 

L  n  ■>  ■)  *  (V) 

+  y /2(1>  +  m2  Y6rdr) 


Using  same  set  of  numbers  and  hydrodynamic  coefficients,  the  final  form 
of  the  equation  is 

v  =*  1.89r  —  6.3  p  —  0.291ar  —  0.03 5up  —  2.563*10~3mv  +  7.568xlO”4u2<5r  (10) 
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IJ>  -  -rp  +  A/)  +  —  ?{Kpup  +  Kfttr  +  A'vi>)  +  ~  l3(Kvuv  +  u2K6r6r)  +  Bz3<f>  (11) 
The  final  form  of  the  equation  is 

p  -  -0.679/-  -  0.0584v-  -  8. 179*  10"  V  -  9.347*10" V  -3.942*1 0"V 

+  3.942*10~V<5r  -  0.2360  (12) 

3)  Equation  of  motion  about  z-axis  (  Yawing  Moment) 

I2r  =*  -y  l5{iYrr  +  A’p/>)  +  -y  ^(Ay/r  f  A‘pt/p  +  A"vv)  +  -y  /3(  A'vuv  +  u2X6rSr)  ( 1 3) 

The  final  form  of  the  equation  is 

r  =  -6.553* \0~3p  +  6.mxl0~*i  -  6.767*10 ~3ur  -4.51 1*10"V  -  4.076*10"suv 

-52-  (1^) 

-1.631*10  V<5r  v 

These  three  equations  are  supposed  to  describe  a  submerged  submarine 
motion  in  the  horizonta'  plane.  The  only  difference  from  the  equations  for  vertical  mo¬ 
tion  is  the  equations  for  the  horizontal  motion  have  the  order  of  the  highest  derivative 
of  all  the  variables  such  as  v,  p  and  r  in  each  particular  equation.  [Ref.  4:  p.  48) 

I  laving  all  of  the  highest  derivatives  in  each  particular  equation  creates 
an  algebraic  loop  problem  for  the  simulation.  To  solve  this  problem  it  is  possible  to 
manipulate  the  equations  to  eliminate  the  highest  order  derivative  from  one  of  the 
equations  which  includes  the  other  derivative  as  it  was  done  before  for  the  vertical  plane 
equations  of  motion.  This  was  done  very  nicely  for  the  case  of  two  equations  but  does 
not  seem  to  be  very  attractive  when  there  are  three  or  more  equations  involved. 

There  are  some  other  possible  ways  to  solve  algebraic  loop  problems.  But 
since  the  new  version  of  DSL  [Ref.  5]  can  take  care  of  this  problem  automatically,  it  is 
preferred  to  use  those  equations  in  simulation. 

A  complete  block  diagram  for  horizontal  motion  is  given  in  Figure  3. 
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Figure  3.  Block  Diagram  Tor  the  Linearized  Model  on  (he  Horizontal  Plane 
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c.  validation  of  linear  model 

The  objective  of  this  section  is  to  compare  the  dynamics  of  the  standard  model  witn 
the  derived  linear  model  in  both  vertical  and  horizontal  planes. 

In  order  to  compare  both  models  they  should  be  in  the  same  initial  state  and  both 
models  have  to  be  in  trim.  In  trim  has  the  meaning  that  the  submarine  maintains  depth 
at  a  given  speed  with  the  desired  pitch  angle  without  using  bow  or  stern  planes.  When 
making  linearizing  assumptions  the  terms  which  are  related  to  trim  are  already  ignored. 
Therefore  the  linearized  model  will  be  in  trim  at  all  times.  Because  of  the  submarine  hull 
and  sail  structure  it  is  required  to  adjust  ballast  tanks  for  given  speed.  The  corrections 
for  trim  which  are  used  in  the  simulation  for  this  study  are  obtained  from  an  earlier 
thesis  study.  [Ref.  6:  p.  1S4J 

To  validate  the  linear  model  it  is  preferred  to  obtain  both  the  initial  condition  and 
forced  response  in  order  to  make  sure  that  the  linear  model  is  working  properly. 

1.  Validation  of  Linear  Model  on  Vertical  Plane 
a.  Initial  Condition  Response 

It  was  expected  that  for  small  perturbations  the  deviations  between  models 
should  be  small.  Therefore  initial  conditions  of  5°  in  pitch  were  tested  first.  For  the  linear 
model  it  is  also  required  to  give  an  initial  value  for  depth  change  which  was  defined  as: 

z  *  -uSin  0 

Test  runs  up  to  360  sec.  in  the  speed  range  5  to  25  Knots  were  performed 
simultaneously  for  both  models.  Maximum  dill'erenccs  for  each  run  were  obtained  from 
data  files  and  given  in  Table  1.  The  pitch  and  depth  behaviors  for  both  models  were 
given  in  Fig.  4-S. 


Table  !.  INITIAL  CONDITION  RESPONSE  TO  5  DEGREE  PITCH  ANGLE 


Run 

No. 

■ 

Maximum  Deviation  In 

Fig. 

Pitch 

Z 

Depth 

Deg. 

To 

Ft.  sec. 

To 

Feet 

To 

1 

5 

0.0901 

1.8 

0.0017 

0.2 

0.1050 

0.1 

4 

2 

8 

0.0608 

1.2 

0.069 

0.6 

0.6740 

0.7 

5 

3 

12 

0.0302 

0.6 

0.0113 

0.6 

1.0960 

1.1 

6 

4 

18 

0.0486 

1.0 

0.0275 

1.0 

3.4200 

1.4 

7 

5 

25 

0.1 90S 

3.S 

0.1599 

4.3 

11.960 

4.8 

S 

As  can  be  easily  seen  from  the  figures  and  Table  1  all  deviations  are  very 
small  lor  this  initial  condition.  That  means  dynamics  for  both  model  are  nearly  identical 
for  small  perturbations. 

In  normal  operational  conditions  a  submarine  never  exceeds  20*  pitch  an¬ 
gle.  But  theoretically  maximum  allowed  pitch  angle  is  limited  to  about  45°.  Therefore 
three  more  runs  were  performed  with  45°  initial  pitch  to  see  large  perturbation  ell'ects 
on  system  dynamics.  Simulation  results  for  45°  initial  pitch  angle  are  given  on  Figures 
9-11.  Maximum  deviations  for  pitch  angle,  speed  in  the  z  direction  and  depth  are  given 
in  Table  2.  Maximum  deviation  docs  not  exceed  7%  for  this  case  as  can  be  seen  in  Table 
2. 


Table  2.  INITIAL  CONDITION  RESPONSE  TO  45  DEGREE  PITCH  ANGLE 


Run 

No. 

Speed 

(Kts.) 

Maximum  Deviation 

n 

Fig. 

Pitch 

Z 

Depth 

Deg. 

■H 

Ft.,  sec. 

% 

Feet 

% 

6 

5 

0.S449 

1.9 

0.2408 

4.0 

18.470 

mam 

9 

7 

8 

1.1988 

■m 

0.1997 

2.1 

9.690 

1.9 

10 

S 

12 

2.486 

5.5 

0.9760 

6.8 

65.260 

wm 
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The  deviations  between  both  models  for  a  second  set  of  initial  conditions 
are  much  bigger  but  still  leads  to  very  similar  dynamic  behavior.  This  was  expected  as 
the  angle  approximation 

sin  6  =  0  (15) 

is  not  as  valid  as  for  5°  initial  pitch  engle.  In  general  for  both  sets  of  initial  conditions 
it  is  observed  that  increasing  speed  tends  to  increase  the  deviations  between  trajectories. 
b.  Forced  Response 

Both  stern  and  bow  planes  can  be  used  in  different  combinations  to  keep 
the  ordered  depth  and  pitch  angle,  In  order  to  validate  the  linear  model  it  is  required  to 
include  some  control  plane  commands  in  the  simulation.  Since  the  mechanical  limit  for 
the  planes  is  about  35°,  test  runs  were  performed  up  to  this  angle.  It  is  also  desired  to 
keep  the  submarine  in  maximum  allowed  pitch  and  depth  limits.  For  the  simulation  runs 
which  are  performed  only  with  bow  plane,  5,  15  and  35  degree  plane  angles  were  applied 
after  the  first  ten  seconds. 
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PfTCH(DECREES)  DEP1H<F.X0 


IN.  COND.  RESPONSE  FOR  DEPTH  U  -  5KTS. 


IN.  COND.  RESPONSE  FOR  PITCH  U  -  5KTS. 


Figure  4.  Initial  Condition  Response  I  nit.  Pitches  Deg.  U=  5  Ivts. 
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PtTCH(DEGREES)  DEPTH(FEET) 


IN.  CONO.  RESPONSE  FOR  DEPTH  U  »  5KTS. 


Figure 


IN.  COND.  RESPONSE  FOR  PITCH  U  -  SKTS. 


5.  Initial  Condition  Response  I  nit.  Pitch  =  5  Deg.  U=8  Kts. 
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PrTCH(DEGREES)  DEPTH  (FEET) 


I 

l 

I 

I 

i 
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IN.  COND.  RESPONSE  FOR  PITCH  U  -  12KTS. 


Figure  6.  Initial  Condition  Response  Suit.  Pitch*  5  Deg.  U85  12  Kts. 
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IN.  COND.  RESPONSE  FOR  DEPTH  U  -  IB  KTS. 


IN.  COND.  RESPONSE  FOR  PITCH  U  -  IB  KTS. 


Figure  7.  Initial  Condition  Response  Knit.  Pitch  —  5  Deg.  U=  18  Kts. 
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RTCH(OEGnEES)  OEPTH(FEET) 

2  3  *  5  50  100  150  200 


IN.  COND.  RESPONSE  FOR  DEPTH  U  »  25  KTS. 


0  100  300  300 


TIME(SEC.) 


IN.  COND.  RESPONSE  FOR  PITCH  U  -  25  KTS. 


0  100  200  300 


TIME(SEC.) 


Figure  8.  initial  Condition  Response  I  nit.  Pitch  =  5  Deg.  U=  25  Kts. 
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PTTCH(DZGREES)  DEPTH(FEET) 


IN.  COND.  RESPONSE  FOR  DEPTH  U  ■  5  KTS. 


IN.  COND.  RESPONSE  FOR  PITCH  U  ■  5  KTS. 


Figure  9.  Initial  Condition  Response  1  nit.  Pitch  -  45  Deg.  U  =  5  Kts. 
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PrTCH(CEGREES)  DEPTH(FEET) 


IN.  COND.  RESPONSE  FOR  DEPTH  U  ■  8  KTS. 


IN.  COND.  RESPONSE  FOR  PITCH  U  -  8  KTS. 


Figure  10.  Initial  Condition  Response  1  nit.  Pitch  =  45  Deg.  U  =  8  Ivts. 
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FITCH(DECaEES)  DEFTH(FEET) 


IN.  COND.  RESPONSE  FOR  OEPTH  U  ■  12  KTS. 


20 


Because  of  the  enormous  effect  of  the  stern  plane  on  submarine  pitch  angle, 
it  was  concluded  to  use  reverse  angles  for  30  seconds  each  and  then  to  bring  the  stern 
plane  to  the  neutral  condition. 

Maximum  deviations  were  obtained  from  data  files  by  a  FORTRAN  pro¬ 
gram  and  given  in  Table  3,  4  and  5  for  bow  planes,  stern  planes  and  both  planes  re¬ 
spectively. 

The  test  simulation  results  which  were  obtained  with  the  bow  planes,  are 
given  in  Figures  12  through  20.  Figures  12,  IS  and  18  represent  small  perturbations  for 
three  different  speeds  and  it  can  also  be  observed  from  Table  3  that  maximum  deviation 
is  not  more  than  23  ft.  for  depth  and  not  more  than  0.4  degree  for  pitch  angle.  Figures 
13,  16  and  19  were  given  for  15  degree  bow  plane  and  except  for  Figure  19  which  re¬ 
presents  the  simulation  with  IS  Kts.  forward  speed,  the  linear  model  is  acceptable.  For 
35  degree  bow  planes,  the  linear  model  is  valid  only  for  lower  speeds  as  can  be  seen  from 
Figures  14,  17  and  20. 


Table  3.  FORCED  RESPONSE  TO  BOW  PLANES 


Ran 

No. 

Speed 

(Kts.) 

Bow 

Plane 

(Deg.) 

Maximum  Deviation  In 

Fig- 

Pitch 

Z 

Depth 

Deg. 

mm 

wmSMt 

Ft.,  sec. 

— 

Feet 

— 

mm 

5 

5 

0.0850 

19.8 

0.0046 

3.2 

1.420 

1.0 

12 

10 

5 

15 

0.3751 

29.2 

0.0128 

3.1 

0.500 

0.2 

13 

11 

5 

35 

1.4706 

68.2 

0.2285 

22.6 

58.980 

14.1 

14 

12 

12 

5 

0.3598 

35.6 

0.1006 

19.0 

21.750 

11.5 

15 

13 

12 

15 

2.5177 

82.5 

0.6860 

43.2 

148.25 

33.1 

16 

14 

12 

35 

9.0961 

127.7 

1.9668 

53.1 

3S2.52 

40.4 

17 

15 

18 

5 

0.4103 

19.0 

0.1743 

19.2 

23.650 

14.4 

18 

16 

IS 

15 

5.1356 

79.3 

2.4369 

89.7 

557.87 

103.7 

19 

17 

18 

35 

19.340 

128.0 

8,1425 

128.5 

1852.8 

110.8 
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DEPTH  CHANCE  WITH  5  DEGREE  DOWN  BOW  PLANE 


WE(SEC.} 


PITCH  ANGLE  WITH  5  DEGREE  DOWN  BOW  PLANE 


0  100  200  300 


TIME(SEC.) 


Forced  Response.  Bow  Plane  =  5  Deg.  down.  U  =  5  Kts. 


Figure  12 
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PITCH  (CECREE5)  DEPTH  (FEET) 

0  12  3  ICO  2C0  300 


FORCED  RESPONSE  WITH  15  DEC.  DOWN  BOW  PLANE 


Figure  16.  Forced  Response.  Don  Plane  =  15  Deg.  down.  U  =  12  Kts. 
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PITCH  (DECREES)  DEPTH  (FEET) 


FORCED  RESPONSE  WITH  35  DEG.  DOWN  BOW  PLANE 


0  100  200  300 


TIME  (SEC.) 


Figure  17.  Forced  Response.  Bow  Plane  =  35  Deg.  down.  U  =  12  Kts. 
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PITCH  (DECREES)  DEPTH  (FEET) 


FORCED  RESPONSE  WITH  15  DEG.  DOWN  BOW  PLANE 


Figure  19.  Forced  Response.  Bon  Plane  =  15  Deg.  down.  U  =  18  Kts. 
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Therefore  the  linear  model  is  valid  for  all  speeds  for  small  plane  angles.  And 
in  general,  it  is  possible  to  say  that  for  the  first  1 20  seconds  the  linear  model  does  work 
well  enough  for  large  perturbations.  In  fact  it  is  not  very  often  that  a  watch  officer 
wants  to  keep  the  bow  planes  full  down  for  more  than  120  seconds  in  a  real  submarine. 

The  test  run  results  which  are  obtained  with  stern  plane,  are  given  in  Fig¬ 
ures  21  to  29  and  Table  4.  Similarly,  deviations  are  acceptable  for  small  and  medium 
perturbations  as  can  be  seen  from  the  figures.  The  only  condition  for  which  the  linear 
model  can  not  be  accepted  as  valid,  is  displayed  in  Figure  29  which  represents  35  degree 
bow  planes  with  18  Kts.  forward  speed.  This  is  expected  since  two  important  linearizing 
assumption  are  invalid  at  this  speed  and  resulting  pitch  .  ngles  are  large.  As  mentioned 
before,  the  constant  speed  assumption  for  large  plane  angles  and  the  sin(x)  =  x  ap¬ 
proximation  for  pitch  angle  arc  no  longer  valid  for  this  run. 


Table  4.  FORCED  RESPONSE  TO  STERN  PLANES 


Run 

No. 

1 

’  1 

fjggg 

Maximum  Deviation  In 

Fig. 

Pitch 

Z 

Depth 

Deg. 

mm 

Ft.'sec. 

■■ 

Feet 

■■ 

IS 

5 

5 

0.0910 

5.6 

0.0016 

1.2 

0.1030 

0.1 

21 

19 

5 

15 

0.1808 

3.8 

0.0126 

3.3 

0.7400 

0.7 

22 

20 

5 

35 

0.9021 

8.2 

0.1463 

16.4 

4.6610 

3.8 

23 

21 

12 

5 

0.3673 

5.6 

0.1070 

6.0 

5.000 

3.0 

24 

22 

12 

15 

2.5750 

13.1 

0.S569 

15.9 

35.6S0 

12.1 

25 

23 

12 

35 

12.010 

26.1 

5.2815 

42.1 

185.53 

33.5 

26 

24 

18 

5 

1.5585 

12.6 

0.7962 

14.2 

59.406 

19.0 

27 

25 

18 

15 

8.4160 

22.6 

4.8350 

28.8 

201.84 

27.4 

28 

26 

IS 

35 

33.619 

38.8 

23.068 

58.8 

844.42 

53.3 

29 

To  be  able  to  observe  the  effects  of  both  planes  on  deviations  between 
models,  nine  more  runs  were  performed  using  stern  and  bow  planes  simultaneously.  For 
each  run  the  same  bow  and  stern  plane  angles  were  applied  in  such  a  manner  so  they 
can  suppress  each  other's  effect  in  order  not  to  exceed  submarine  depth  and  pitch 
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PITCH  (OECTEES)  DEPTH  (FEET) 

-202  ICO  104  103 


figure  22.  Forced  Response.  Stern  Plane  =  15  Deg.  U  =  5  Kts. 
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DEPTH  (FEET) 

35  110  115  120 


FORCED  RESPONSE  WITH  35  DEG.  STERN  PLANE 


Figure  23.  Forced  Response.  Stern  Plane  «  35  Deg.  U  =  5  Kls. 


34 


PITCH  (DECREES) 


FORCED  RESPONSE  WITH  5  DEC.  STERN  PUNE 


Figure  24.  Forced  Response.  Stern  Plane  ■  5  Deg.  U  ■»  12  Kls. 
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300 


Figure  25.  Forced  Response.  Stern  Plane  *=  15  Deg.  U  ■  12  Kts. 
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PITCH  (DECREES)  DEPTH  (FEET) 

-20  0  20  100  200  330  » 


FORCED  RESPONSE  WITH  35  DEG.  STERN  PLANE 


Figure  26.  Forced  Response.  Stern  Plane  «  35  Deg.  U  **  12  Kts. 


PITCH  (DECREES)  DEPTH  (FEET) 

1-4  0  4  50  103  ISO  SCO 


FORCED  RESPONSE  WITH  5  DEG.  STERN  PLANE 


0  TOO  300  300 

TIME  (SEC.) 


0  too  200  000 

TIME  (SEC.) 


Figure  27.  Forced  Response.  Stern  Plane  =  5  Deg.  U  =  18  Kls. 
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PITCH  (DECREES)  DEPTH  (FEET) 


FORCED  RESPONSE  WITH  15  DEG.  STERN  PLANE 
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PITCH  (DECREES)  DEPTH  (FEET) 


FORCED  RESPONSE  WITH  35  DEG.  STERN  PLANE 
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limitations.  Figures  were  created  but  not  supplied  in  this  study  since  they  are  very  similar 
to  the  precceding  results  which  were  obtained  using  only  stern  planes.  Deviations 
between  models  for  this  last  set  of  runs  are  a  little  bit  larger  than  the  proceeding  results. 
Using  two  sets  of  planes  means  more  approximations  for  the  linear  model  and  greater 
deviations  between  linear  and  nonlinear  models  are  expected. 


Table  5.  FORCED  RESPONSE  TO  BOW  AND  STERN  PLANES 


^9 

Bow 

Maximum  Deviation  In 

! 

Run 

No. 

& 

Stern 

Plane 

Pitch 

Z 

Depth 

Fig. 

Deg. 

mm 

Ft., 'sec. 

Feet 

mm 

27 

5 

5 

0.0943 

6.8 

0.0012 

1.1 

0.0500 

0.05 

28 

5 

15 

0.244S 

6.0 

0.0262 

8.0 

0.9030 

0.8 

29 

5 

35 

1.3542 

14.2 

0.2891 

37.7 

8.0200 

7.1 

30 

12 

5 

0.5151 

mm 

0.1 55S 

S.9 

7.2100 

warn 

31 

12 

15 

3.6320 

19.8 

1.3423 

25.6 

53.000 

18.3 

32 

12 

35 

16.329 

3S.2 

7.1826 

58.8 

262.15 

48.4 

33 

IS 

5 

2.0117 

16.8 

1.0424 

18.5 

61.856 

19.6 

34 

IS 

15 

11.203 

31.2 

6.6167 

39.1 

267.52 

35.8 

- 

35 

IS 

35 

43.214 

51.6 

27.816 

70.4 

1053.8 

65.5 

- 

Obviously  the  linear  model  docs  not  behave  like  the  nonlinear  model  for 
large  plane  angles  and  high  speeds.  The  most  important  reason  for  this  is  the  constant 
speed  assumption  for  the  linear  model.  This  assumption  is  no  longer  valid  for  large  plane 
angles  since  planes  reduce  the  forward  speed  of  the  actual  submarine.  Since  the  aim  of 
this  study  is  to  validate  the  linear  model  for  small  perturbations,  it  is  achieved  for  the 
vertical  plane. 

2.  Validation  of  (he  Linear  Model  on  the  Horizontal  Plane 

A  submarine  behaves  like  a  surface  ship  for  most  horizontal  motions.' There  arc 
some  differences  because  of  its  submerged  condition  and  sail  structure.  The  main  differ¬ 
ence  is  in  roll.  A  submarine  rolls  to  inboard  when  a  rudder  angle  is  applied.  Also  the 
rudder  has  a  squatting  effect  on  the  submarine  which  makes  the  submarine  to  pitch  up 
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and  dive.  Since  the  linear  model  assumes  that  there  is  no  cross-coupling  between  vertical 
and  horizontal  motion  it  is  not  possible  to  compare  the  squatting  effect  with  the  linear 
model. 

On  the  horizontal  plane,  roll  and  yaw  angles  and  sway  speed  can  be  observed. 
Roll  and  yaw  information  are  displayed  on  figures  and  tables  for  convenience.  But  the 
sway  response  is  only  supplied  on  tables  as  deviation  between  models. 
a.  Initial  Condition  Response 

The  simulations  were  carried  out  with  a  ct.  ain  roll  angle  as  initial  condi¬ 
tion.  In  order  to  see  the  small  and  large  perturbations  effects,  5  and  25  degrees  initial  roll 
angles  were  chosen  and  test  runs  were  performed  at  5,  8,  12,  18  and  25  Kts. 

Since  both  models  reach  a  steady  state  value  after  about  1 20  seconds,  sim¬ 
ulations  up  to  120  seconds  were  performed,  simultaneously  for  both  the  linear  and  non¬ 
linear  models.  Maximum  deviations  for  each  run  were  obtained  from  data  files  and  arc 
given  in  fable  6. 


Table  6.  INITIAL  CONDITION  RESPONSE  FOR  HORIZONTAL  PLANE 


Run  No. 

Maximum  Deviation  In  Roll 

Figures 

Init.  Roll 

■  5  Deg. 

Init.  Roll® 

•  25  Deg. 

Degree 

% 

Degree 

o 

0 

36-37 

5 

0.0972 

1.9 

3.2242 

msH 

30-32 

38-39 

8 

0.0677 

1.3 

2.0457 

8.2 

30-33 

40-41 

12 

0.0365 

0.7 

1.3490 

5.4 

31-33 

42-43 

18 

0.0342 

0.7 

1.1720 

4.7 

31-34 

44-45 

25 

0.0252 

0.5 

1.0160 

4.1 

BUSH 

As  can  be  seen  from  Figures  30.  31  and  32,  it  is  obvious  that  there  is  almost 
no  deviation  on  roll  response  for  5  degree  initial  roll  ang.e.  There  arc  some  slight  devi¬ 
ations  for  25  degree  initial  roll  angle  and  unlike  the  vertical  plane,  deviations  arc  de¬ 
creasing  with  increasing  axial  speed.  It  is  to  be  noted  that  the  approximation  by  a  linear 
model  has  not  affected  the  period  of  rolling.  Simulation  results  arc  given  on  Figures  32, 
33  and  34  for  25  degree  initial  roll  angle  response. 

Therefore  it  has  been  concluded  that  the  linear  model  on  horizontal  plane 
is  valid  for  small  and  large  initial  conditions. 
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ROLL  (DECREES)  ROLL  (DECREE) 


INIT.  COND.  RESPONSE  -  INIT.  ROLL  ■  5  DEG 


IN!T.  COND.  RESPONSE  -  INIT.  ROLL  -  25  DEG 


Figure  32.  Init.  Cond.  Response  Inii.  Roll  =  5  and  25  Deg.  U=  25  and  5  Kts. 
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ROLL  (DECREES)  ROLL  (DEGREES) 


INIT.  CONO.  RESPONSE  -  INfT.  ROLL  *=  25  DEC 
AXIAL  SPEED  U  -  18  KTS. 


Figure  34.  Initial  Condition  Response  Init.  Roll 53  25  Deg.  U=  18  and  25  Kts. 
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b.  Forced  Response 

The  only  relevant  force  beside  propellers  is  created  by  the  rudder  on  hori¬ 
zontal  plane.  The  rudder  also  has  an  appreciable  effect  on  vertical  motion  which  is  called 
the  squatting  effect.  Even  though  the  linear  model  assumes  that  there  is  no  cross¬ 
coupling  effect  between  vertical  and  horizontal  motion,  it  was  decided  to  display  depth 
and  pitch  angle  changes  which  were  obtained  by  non-linear  simulation  for  further  study. 
Cross-coupling  effects  which  are  obtained  by  non-linear  simulation  at  different  speeds, 
are  given  in  Figures  38,  40,  42,  44,  46,  48  and  50. 

Simulation  runs  are  abtained  for  three  different  speeds  and  rudder  angles  for 
this  ease.  Plots  for  yaw  and  roll  response  are  given  in  Figures  35-37,  39,  41,  43,  45,  47 
and  49.  Maximum  deviations  are  given  on  Table  7.  Again  similar  deviation  behaviors 
can  be  observed  as  vertical  motion. 


Table  7.  FORCED  RESPONSE  TO  RUDDER 


Run 

No. 

Speed 

(Kts.) 

Rudder 

(Deg.) 

Maximum  Deviation  In 

n 

V 

Yaw 

Ro 

1 

Ft  see. 

% 

Deg. 

mm 

Deg. 

% 

46 

5 

5 

0.0060 

3.6 

0.3775 

13.7 

0.0041 

3.0 

35 

47 

5 

15 

0.0487 

9.8 

2.0360 

24.7 

0.0518 

ESI 

36 

48 

5 

35 

0.2413 

20.8 

3.3520 

17.4 

0.3633 

38.3 

37 

49 

12 

5 

0.1417 

14.9 

2.8058 

23.8 

0.2880 

18.6 

38 

50 

12 

15 

0.9515 

33.6 

13.27 

37.5 

2.6034 

56.0 

39 

51 

12 

35 

3.7804 

57.2 

42.223 

51.1 

10.345 

HI 

40 

52 

IS 

5 

0.5104 

25.3 

6.97 

30.3 

1.6658 

35.0 

41 

53 

IS 

15 

3.0963 

51.2 

35.065 

50.8 

11.262 

78.9 

mm 

54 

IS 

35 

10.424 

73.8 

106.83 

66.4 

34.525 

103.6 

43 

As  a  result  of  this  chapter  it  has  been  concluded  that  approximation  by 
linear  model  is  valid  for  small  perturbations  at  all  speeds  for  both  motions.  In  addition, 
it  has  been  observed  that  the  linearized  model  is  still  valid  for  large  perturbations  applied 
over  a  short  period  of  time. 
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YAW  (CECREE5)  ROU.  (DECREES) 

—2.5  -2.0  -1.5  -1.0  -0.5  0  -0.12  -0.08  -0.0* 


FORCED  RESPONSE  WITH  5  DEG.  RUDDER 


figure  35.  Forced  Response.  Rudder  =  5  Deg.  U  =  5  Kts. 
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YAW  (DECREES)  ROLL  (DECREES) 


FORCED  RESPONSE  WITH  IS  DEG.  RUDDER 
AXIAL  SPEED  U  -  5  KTS. 


Figure  36.  Forced  Response.  Rudder  =  li>  Deg.  U  =  5  Kts. 
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YAW  (DECREES)  ROLL  (DEGREES) 


FORCED  RESPONSE  WITH  35  DEG.  RUDDER 


TIME  (SEC.) 


Figure  37.  Forced  Response.  Rudder  =  35  Deg.  U  =  5  Kts. 
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PITCH  (DECREES)  DEFl"H  (FEET) 

0.4  0.5  1.2  100  101  102  103  104 


FORCED  RESPONSE  WITH  35  DEG.  RUDDER 


Figure  38.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder  =  35  Deg.  U  =  5  Kts. 
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§ 


FORCED  RESPONSE  WITH  5  DEC.  RUDDER 
AXIAL  SPEED  U  -  12  KTS. 


Figure  40.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder®  5  Deg.  D®  12  Kts. 
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Figure  42.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder =  15  Deg.  U=  12  Kts, 


YAW  (DECREES)  ROLL  (DEGREES) 


FORCED  RESPONSE  WITH  35  DEG.  RUDDER 


figure  43.  Forced  Response.  Rudder  =  35  Deg.  U  =  12  Kts. 
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pitch  (decrees)  depth  (feet) 


FORCED  RESPONSE  WITH  35  DEG.  RUDDER 
AXIAL  SPEED  U  -  12  KTS. 


Figure  44.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder  =  35  Deg.  U=  12  Kts. 
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TAW  (DECREES)  ROU.  (DEGREES) 


Figure 


FORCED  RESPONSE  WITH  5  DEG.  RUDDER 


-15.  Forced  Response.  Rudder  =  5  Deg.  U  =  18  Kts. 
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FORCED  RESPONSE  WITH  5  OEG.  RUDDER 


Figure  46.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder  =5  Deg.  U=  18  Kts. 
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YAVT  (CECREE5)  ROLL  (DEGREES) 


FORCED  RESPONSE  V/fTH  15  DEG.  RUDDER 
AXIAL  SPEED  U  =  18  KTS. 


figure  47.  Forced  Response.  Rudder  =  15  Deg.  U  =  13  Kts. 
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PITCH  (DECREES)  DEPTH  (FEET) 

A  s  a  10  500  6C0  700  sot 


FORCED  RESPONSE  WITH  IS  DEG.  RUDDER 


Figure  48.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder-  15  Deg.  U=  18  Kts. 
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FORCED  RESPONSE  WITH  35  DEG.  RUDDER 


Figure  50.  Cross-Coupling  Effect  on  Vertical  Plane.  Rudder  =  35  Deg.  U=  18  Kts. 
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III.  AUTOMATIC  DEPTH  AND  PITCH  CONTROL 


A.  DESIGN  SPECIFICATIONS 

After  a  valid  linear  model  is  defined,  any  type  of  design  method  for  linear  systems 
can  be  used.  It  is  assumed  that  the  submarine  which  is  considered  in  this  study  has  no 
inertial  guidance  system.  That  means  rate  information  is  not  available  and  the  only 
states  to  be  used  as  feedback  are  depth,  pitch  and  speed.  Due  to  this  limited  instrumen¬ 
tation  the  controller  will  have  to  use  cascaded  filters. 

Since  a  submarine  maneuvering  capability  depends  highly  on  the  axial  speed,  it  is 
very  hard  to  satisfy  some  certain  specifications  for  this  kind  of  control  systems.  But 
basically  it  is  acceptable  if  the  control  system  can  achieve  10  ft.  depth  change  in  120 
seconds  and  100  ft.  depth  change  in  240  seconds.  Also  more  than  2  feet  overshoot  is  not 
desirable  for  small  depth  changes  and  overshoot  must  stay  within  5%  for  large  depth 
changes.  Deviation  from  ordered  pitch  must  stay  within  2  degrees. 

for  the  control  system  to  be  designed,  plane  angle  limits  which  arc  about  35  degrees, 
have  to  be  taken  into  the  consideration.  A  depth  and  pitch  control  system  which  requires 
more  than  35  degrees  plane  angles  to  get  the  ordered  depth  or  pitch  is  clearly  not 
realizable. 

B.  DESIGN 

I  he  linearized  equations  of  motion  for  the  vertical  plane  are  obtained  and  given  in 
Chapter  2.  They  arc  repeated  below  for  convenience 

z  =  -1.72S.vl<rV  —0.7061/0  +  (0.01283  - 1.728* lO'V)#  -6.667.vlO~V<u 

4  ,  (16) 
-3.S73.vlO ~VM 

(j  =  1.884.vl0“5»ir  -6.365.vlO-3t/<7  -1.465.y10“V<5j  +3.193.rlO~V(>/> 

<  ,  ,  (17) 

+  (I.S84.vI0  V— 2.522.y1O_3)0 

A  signal  flow  graph  can  describe  the  corresponding  input/output  relations  for  these 
equations.  Inputs  will  be  the  bow  and  stern  plane  angles  and  outputs  of  interest  are 
depth  and  pitch  for  vertical  motion  and  such  a  flow  graph  is  given  in  fig.  51  where 
rt--3.87.vl0-4«* 
b  -  —  1.73.vlO  T/ 
c--I.465.vlO  V 
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Figure  51.  Signal  Flow  Graph  for  Vertical  Equations  of  Motion 


d=  -6.67.y10V 

t’=  3.I9.y10V 

/=  — 6.36.vlO*3i/ 

g=  1 . 8  8.v  1 0  '-V  —  2 . 5  2.r  1  O' 3 

h  =  0.706u 

/-0.013  -  1.73.vlO  V 
k  =  1.SS.y10'5m 
1.  Decoupling 

In  order  to  design  a  cascade  compensator  with  a  single  loop  technique,  one  must 
have  the  independent  input-output  relations  for  each  input  and  output  (Ref.  7  ].  In 
other  words  it  is  necessary  to  obtain  two  transler  functions  for  depth  and  two  transfer 
functions  for  pitch  which  have  the  stern  and  bow  planes  as  inputs. 

Applying  Mason's  gain  rule  to  the  signal  How  graph  given  in  Fig.44  the  input- 
output  relations  will  be  as  follows  [Ref.  8:  p.  S3], 
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2 

depth  as  +  (eh  —  qf)s  +ei  —  ag 


Oh 

•s4  -  (/’+  h)s3  +  (bf- 

-  g  -  klt)s 2 

+  (gh  -  ki)s 

depth 

ds 2  +  (eh  - 

-  dj)s  +ci  - 

<k 

Os 

54  -  (f+  h)S 3  +  (/./• 

-g-  kh)s 2 

+  (gh  -  ki)s 

pitch 

cs  - 

be  +  ak 

Ob 

s3  -  (f+  b)s 2  +  (/)/ 

-g-  kh)s 

+  ( gb  -  ki) 

pilch 

cs  — 

be  +  dk 

s3  -  (f  +  b)s2  +  (bf-  g  -  kh)s  +  (gh  -  ki) 


(18) 


(19) 


(20) 


(21) 


Substituting  the  corresponding  numbers  into  these  equations 

depth  _  -3.87.vlO~4nV  -2.1.d0~y.s  -  9.33.vlO~y  + 1 .75.vHrqn4 
M  sJ  +8.09.vl 0_3i«3  +  (2.52.vKr3  -2.11.vlO_5«V  +4.12.vloA.t 


depth  -CS.67.vl  (TVs2  -6.  l.vlO~Vs  -  1 .87.rlO~6«2  +3.78.v10~y 


Os 


s4  +8.O9.vI0"3ms3  +  (2.52.vl0“3  -2.1  l.tlO~V)s2  +*».12.vl0“fti« 


(23) 


pitch 

Oh 


3. 1 9.V  1 0~6u2s  —  1 .75.v  I  0~V3 


s3  +S.09.tlO~3ws2  +  (2.52.vl()"3  -2.1  l.vlO~V).s  +4.12.v10~6m 


(24) 


pitch 

Os 


_ -1.465.v1O~V.s-1.28.v10~>k3 _ 

s3  +8.09arl0-3t«2  +  (2.52.vlO-3  -2.11.rlO“V)s  +4.l2.vlO~'ii/ 


(25) 


Transfer  functions  which  are  dealing  with  depth,  have  fourth  order  characteristic 
equations  and  they  are  type  one  systems  with  the  same  denominator.  On  the  other  hand, 
transfer  functions  for  pitch  are  type  zero  and  have  third  order  characteristic  equations 
with  the  same  denominator.  Also  all  transfer  functions  have  the  same  poles  except  one 
at  the  origin.  So  it  is  expected  that  they  might  show  similar  frequency  response  and  it 
may  be  possible  to  use  only  one  cascade  compensator  to  compansate  the  whole  system. 

In  order  to  make  further  analysis  on  these  transfer  functions,  the  axial  speed,  u 
has  to  be  defined  as  a  number.  It  is  always  possible  to  design  the  control  system  for  a 
specific  speed  and  check  the  validation  of  design  for  a  certain  speed  range.  Since  slower 
speeds  make  it  harder  to  get  desired  depth  and  pitch  angle,  it  is  not  very  efficient  to  use 
an  automatic  control  for  less  than  5  Knots.  A  possible  approach  would  be  to  use  10 
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ft  see.  (  5.9  Kts.)  as  axial  speed.  If  the  designed  control  system  works  for  this  speed,  it 
will  probably  work  for  the  higher  speeds. 

2.  Design 

With  10  ft. 'see.  axial  speed,  transfer  functions  become 


depth 

db 


-3.S7.t1Q ~V  -2.1.tl0~4i  -  9.33.tlO~s 
s4  -t-8.09.Tl0"V  +0.41.vlO~V  +4.12.vI0“5j 


depth  _  -6.67.Tl0~V-6.06jd0~3s+  l^l.tftT4 

Ss  s4  +8.09a10“V  +0.41.t10-3$2  +4.11t10_S5 

Pitch  _ _ 3.19.t10~45-1.75.t10~< _ 

*b  s3  +8.09.rl0'V  +  0.4lxl0~3s  +4.12.t10_s 


_ —  1.465.t10~3  —  1.2S,t10~s _ 

s3  +8.09.rl0~V  +0.41.t10~3s  +4.12.tlO~5 


It  is  more  convenient  to  rename  these  transfer  functions  such  as 


£u(s)  = 


depth 


,  depth 
gu{s) - ~ 


=  ' 


#22^)  =  ' 


1  hen  the  transfer  function  matrix  becomes 


(7(5)  = 


\sw 

J2\ 


g|l(J)  *I2(*) 
$22^) 


Using  cascade  compensation  and  a  diagonal  compensator  matrix 


(7c(5)  = 


[■&,.(*)  0  1 
L  0  ?c22(?)J 
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The  corresponding  control  model  is  sketched  in  Fig. 52.  The  equivalent  transfer 
function  matrix  will  be 


Gf?=G(s)Ge(s)  = 


(steci  iW 
£21  (steci  i(s) 


^I2(stee22(s) 

^22(stee22(s). 


(36) 


Characteristic  equation  roots  for  these  transfer  functions  are  given  in  Table  8. 
Only  one  transfer  function  has  roots  in  right  half  plane  which  is  £,2(>s). 


Table  8.  CHARACTERISTIC  EQUATION  ROOTS  FOR  VERTICAL  MOTION 


Transfer  Function 

Roots 

-0.392  ±  jO.  188,  -0.001  ±  j0.045 

Su(s) 

-0.030  ±  jO.260,  -0.0646,  0.043 

&i(*) 

-0.014  ±  jO.022,  -0.078 

&i(s) 

-0.008  ±  j0.028,  -0.065 

The  open  loop  Bode  diagrams  and  root  locus  plots  arc  given  on  Figures  53  to 
60.  As  expected  transfer  functions  for  depth  have  similar  frequency  response  with  a  small 
positive  phase  margin.  Also  both  of  them  have  root  locations  on  the  right  half  plane. 
On  the  other  hand  transfer  functions  for  pitch  show  similar  behavior.  They  arc  also 
stable  with  50  and  60  degrees  phase  margin.  The  only  transfer  function  which  is  stable 
for  all  gains  is  g22(.s)  as  can  be  seen  from  Fig.  60. 

From  the  root  locus  diagrams  one  can  easily  see  that,  except  for  g22(.s),  the  other 
three  transfer  functions  have  many  root  locations  on  the  right  half  plane  which  might 
make  the  cascade  compensation  design  required.  Since  g,2(s)  has  characteristic  equation 
roots  in  the  right  half  plane  and  also  the  root  locus  diagram  shows  one  root  location 
branch  that  extends  along  the  positive  real  axis,  it  is  clearly  unstable.  In  particular 
g,,(s)  might  not  need  any  compensation  other  than  a  gain  adjustment. 

The  effect  of  bow  planes  on  pitch  angle  and  the  effect  of  stern  planes  on  depth 
are  rather  small  compared  to  the  effect  of  bow  planes  on  depth  and  stern  planes  on 
pitch.  So  it  is  considered  best  to  focus  on  the  transfer  functions  /»„(.*)  and  g12  while  car¬ 
rying  out  a  design  procedure.  Even  if  the  designed  compensators  for  these  two  transfer 
functions  are  not  satisfactory  for  the  other  two  equations,  the  total  system  response 
might  be  sufficient. 
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Since  the  transfer  functions  for  the  vertical  plane  have  poles  in  the  right  half 
plane,  they  do  not  represent  minimum  phase  systems.  For  a  non-minimum  phase  system 
it  is  more  complicated  to  achieve  a  design  which  meets  the  required  specifications. 
However  it  is  possible  to  start  with  a  very  basic  design  and  improve  it  after  observing 
compensator  effects  on  the  system  behavior. 

From  the  requirements  mentioned  before,  the  settling  time  will  be  more  than 
100  seconds  and  the  damping  coefficient  £  is  about  0.5  for  sufficient  damping.  Using  the 
formula  for  second  order  approximation 


Solving  for  a>„  and  substituting  numbers 


The  gain  crossover  frequency  for  the  uncompensated  system  is  about  0.2 
rad/scc.  as  can  be  seen  from  Fig.  54.  Then  the  gain  which  is  to  be  used  for  the  first 
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figure  53.  Root  Locus  Plot  for  £tl(s) . 
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OPEN  LOOP  BODE  FOR  OEPTH/DB  U-10 
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Figure  54.  Open  Loop  Dude  Plot  for  £,,(.*) . 
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Figure  55.  Root  Locus  Plot  for  £tJ(s)  . 


73 


OPEN  LOOP  BODE  DIRGRflM 
OEPTH/OS  U  -  10  FT. /SEC. 
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Figure  57.  Root  Locus  Plot  for  g„(s) . 
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Figure  59.  Root  Locus  Plot  for  £„($) . 
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Figure  60.  Open  Loop  Bode  Plot  for  £22(s)  . 
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compensator,  lias  to  be  less  than  one  in  order  to  get  the  desired  response.  This  gain 
constant  is  called  Kl  and  taken  as  0.1  for  the  first  trial. 

In  order  to  increase  phase  margin  a  first  order  lead  compensator  is  to  be  added 
to  the  forward  path.  Such  a  compensator  has  the  form 


-  _£.ii±£) 

z  {s  +  p) 


(39) 


The  multiplier  p  z  is  required  to  keep  error  coefficient  constant.  (Ref.  2  ] 

Using  cascade  compensator  design  techniques  the  best  choice  for  the  first  trial 
on  grU  will  be 


_ 1  s  +  0. 1  i a  (•*  +  0  1) 

ScU  “  0.1  s+i.O  “  U  s+  1.0 


(40) 


Multiplying  with  Kl  the  total  compensator  is 


Gc  = 


.s  +  0.1 

s+  1.0 


(41) 


The  root  locus  plot  and  open  loop  Bode  diagram  for  the  compensated  system 
arc  given  on  fig.61  and  fig.  62.  The  compensated  system  has  about  75  degree  phase 
margin  which  is  obviously  more  than  the  specified  requirements.  This  excess  phase 
margin  may  cause  a  request  for  the  large  plane  angles  which  it  is  not  possible  to  supply. 
Since  it  is  always  possible  to  use  limiters  on  plane  angles  it  is  concluded  to  leave  the 
designed  compensator  as  it  is  and  use  it  for  preliminary  design  procedures. 

Since  g:i(s)  is  already  very  reasonable  well  damped,  no  compensator  will  be  used 
and  K2  will  be  taken  as  1.0  for  the  first  trial. 

T  he  next  step  is  to  put  the  compensator  in  the  actual  linear  system  and  observe 
the  response  of  the  system.  But  before  doing  that  the  simulation  program  has  to  be  up¬ 
dated  in  order  to  get  more  realistic  results  and  accuracy. 
a.  Limiters 

The  mechanical  limit  for  both  plane  dcllcctions  is  35  degree.  But  it  is  not 
desirable  to  use  full  plane  angles  for  higher  speeds.  Also  it  is  possible  to  limit  planes  and 
the  error  signals.  The  test  runs  which  are  achieved  with  limited  planes  led  to  unaccepta¬ 
ble  plane  behavior  such  as  very  small  deflections.  Under  these  set  of  circumstances  it 
was  concluded  to  limit  the  error  signal  such  as: 
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Figure  61.  Root  Locus  Plot  for  Gft?„ . 
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lim  =  35  when  u  <  15  IV sec. 

lim  =  25  when  15  <  u  <  30  IV' sec. 

lim  =15  when  u  >  30  ft/ see. 

Obviously  this  limiter  docs  not  have  any  eRcct  lor  less  than  15  ft.  depth 
changes  where  there  is  no  need  for  a  limiter. 
b.  Actuators 

The  linearized  model  docs  not  include  the  dynamics  of  the  plane  actuators, 
which  arc  force  and  moment  producers.  The  actuator  dynamics  were  ignored  in  the 
model  comparison  part  of  this  study.  In  order  to  have  an  accurate  model  for  the  design 
procedure,  an  actuator  model  has  to  be  added  to  the  system  dynamics.  Such  an  actuator 
model  was  developed  by  |Ref.  6  1  and  represented  as 


G*tim 
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Figure  63.  Block  Diagram  for  Compensated  Linear  Model  in  Vertical  Motion 
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3.  Simulation 

The  simulation  program  is  written  based  on  the  discussed  subjects  above.  The 
fust  run  was  made  with  the  preliminary  design  gains,  poles  and  zeros.  Then  required 
corrections  were  made  in  order  to  meet  the  design  specifications.  The  DSL  simulation 
program  with  the  final  parameters  is  given  in  Appendix  F. 

Test  run  results  which  were  achieved  with  different  sets  of  parameters  arc  given 
in  Figures  64  to  74.  Each  run  is  explained  briefly  below: 

Run  No.  1: 

The  simulation  program  was  run  with  the  first  set  of  parameters  for  10  ft.  depth 
change  and  10  ft,  see.  axial  speed  which  is  the  lower  limit  for  this  compensation.  With 
K  1  =  0.1  the  required  bow  plane  angle  was  very  large  and  overshoot  was  25%.  This  run 
does  not  meet  the  specified  requirements. 

Run  No.  2: 

In  order  to  get  reasonable  plane  response  it  is  decided  to  reduce  K1  to  the  value 
of  0.01.  This  time  the  maximum  bow  plane  dellection  is  26  degree  but  the  time  required 
to  reach  10  feet  depth  change  is  a  little  longer  than  the  specification.  This  run  is  also 
discarded. 

Run  No.  3: 

A  third  approach  would  be  to  change  KI  to  0.015.  The  result  was  quite  satis¬ 
factory  except  the  40  degree  maximum  bow  plane  angle.  The  main  reason  for  this  larger 
plane  request  is  the  excess  phase  margin  on  the  system.  The  one  possible  way  to  reduce 
phase  margin  is  to  shift  the  cascade  compensator  one  decade  up  in  the  frequency  do¬ 
main. 

Run  No.  4: 

l.' sing  the  new  compensator  with  one  zero  at  1.0  and  one  pole  at  10.0.  the  results 
arc  satisfactory.  As  can  be  seen  from  figure  66  the  maximum  required  bow  plane  angle 
is  10  degrees,  the  time  to  complete  10  ft.  depth  change  is  78  sec.  and  the  overshoot  is 
10%.  This  excess  overshoot  is  the  payoff  for  reducing  the  phase  margin  but  since  it 
makes  only  one  loot  dillerencc,  it  is  acceptable. 

Run  No.  5: 

It  is  desired  to  check  the  system  response  for  large  depth  changes.  The  simu¬ 
lation  program  was  run  for  a  100  ft.  depth  change.  Maximum  required  bow  plane  angle 


S3 


is  34  degrees  and  overshoot  is  5%.  At  this  point  it  seems  that  the  compensated  linear 
model  for  depth  control  is  acceptable. 

It  is  also  required  to  check  the  pitch  response  of  the  system.  Test  runs  were 
performed  with  zero  depth  and  some  certain  pitch  angle  change.  Because  of  the  bow 
plane  effect  (which  tries  to  keep  the  submarine  at  the  same  depth)  there  was  a  steady 
state  error  on  pitch  angle.  Since  this  pitch  error  relates  very  closely  to  K2,  it  is  concluded 
to  increase  K2  to  2.0. 

Runs  No. 6  and  7: 

To  make  sure  that  there  is  no  negative  effect  on  depth  behavior  of  the  system 
created  by  the  hew  K2  parameter,  two  more  runs  were  achieved  with  K2  =  2.0  for  10  and 
100  feet  depth  change.  Since  there  was  only  a  slight  change  on  overshoot,  the  new  K2 
value  is  accepted  and  used  for  further  study. 

Run  No.  8 

In  order  to  check  the  pitch  response  of  the  compensated  system,  a  *5  degree 
pitch  command  was  ordered  while  the  depth  change  command  was  zero.  System  has 
reached  the  ordered  pitch  angle  in  46  seconds  and  because  of  the  bow  plane  effect,  it 
settled  on  -4  degree.  Increasing  K2  might  decrease  this  steady  state  error  but  at  the  same 
time  it  might  create  more  overshoot  and  instability  problems  on  depth  behavior  of  the 
system.  Since  a  1  degree  error  is  in  the  specifications  limits,  K2  =  2.0  will  be  used  for 
further  study. 

Runs  No.  9  and  10: 

The  next  step  is  to  check  the  designed  system  for  a  certain  range  of  speed.  For 
15.2  ft., 'sec.  {  9  Kts.  )  two  runs  were  performed  with  10  and  10O  ft.  depth  change.  As  it 
can  be  seen  from  Fig.s  69  and  70  there  is  12%  overshoot  for  10  ft.  depth  change  and  3% 
for  100  ft.  depth  change.  Increasing  the  speed  has  a  positive  elfect  for  large  depth 
changes  while  having  a  negative  clfect  for  small  ones. 

Runs  No.  11  and  12: 

The  axial  speed  was  increased  to  12  Kts.  The  system  reaches  the  ordered  depth 
in  shorter  time  and  has  only  2%  overshoot  for  100  ft.  depth  change. 

Runs  No.  13  and  14: 

Two  more  test  runs  were  performed  with  18  Kts.  axial  speed.  As  can  be  seen 
from  Fig.s  21  and  22  the  compensated  control  model  is  still  valid  and,  in  fact,  works 
better  with  only  1%  overshoot  for  large  depth  change. 

Finally  it  is  considered  that  the  designed  automatic  control  for  the  linearized 
vertical  motion  using  cascade  compensator  design  techniques  is  satisfactory  and  should 
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be  checked  with  actual  non-linear  model.  After  designing  another  cascade  compensator 
lor  the  horizontal  motion,  both  models  will  be  checked  in  order  to  sec  whether  the  design 
is  completed  or  needs  some  alterations. 


OEPTH  (FEET)  DEPTH  (FEET) 


10  FT.  DEPTH  CHANGE  U  -  10  FT./SEC. 
K  t  =0.1  K2=1.0 


K1-0.01  K2-1.0 


Figure  64.  Compensated  System  Depth  Response  Z  =0.1,  P  =  1.0 


86 


10  FT.  DEPTH  CHANGE  U  -  10  FT./SEC. 


Z-1.0  P-10.0 


Figure  65.  Compensated  System  Depth  Response  K1  =0.015,  K2  =1.0 


87 


PUNE  DEFLECTIONS  U  -  10  FT./5EC. 


2-1.0  P-10.0 


Figure  66.  Plane  Angle  Deflections  for  first  and  second  Compensator 
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71.  Coinpensnted  System  Response  to  10  ft.  Depth  Change  U  =  12  Kts. 
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100  FEET  DEPTH  CHANGE  U  •  12  KTS. 


PLANE  DEFLECTIONS 


Figure  72.  Compensated  System  Response  to  100  ft.  Depth  Change  U*  12  Kts. 
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10  FEET  DEPTH  CHANGE  U  -  It  KTS. 


PLANE  DEFLECTIONS 


Figure  73.  Compensated  System  Response  to  10  ft.  Depth  Change  U=  i«S  Kts. 
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IV.  AUTOMATIC  STEERING  CONTROL 


Turning  characteristics  of  a  surfaced  submarine  arc  very  similar  to  a  surface  ship. 
But  the  situation  in  the  submerged  position  shows  big  differences.  Sail  structure  can  be 
considered  the  main  difference  and  the  main  source  of  rolling.  But  roll  control  is  not 
considered  in  this  study  since  the  main  purpose  was  to  control  depth  change  which  is 
caused  by  the  rudder. 

In  Chapter  2,  three  equations  of  motion  were  linearized  and  derived  for  the  hori¬ 
zontal  plane.  Same  equations  will  be  used  to  design  a  steering  control  for  a  submerged 
submarine.  But  the  algebraic  loop  problem  has  to  be  solved  before  using  Mason's  gain 
rule. 

Three  linear  equations  for  horizontal  motion  are 

i  =  1 .89/-  -  6.3 p  -  0.291ur  -  0.03 Sup  -  2.563.rlO“3uv  +  7.568.x  I0“V«5r  (43) 

P  =  -0.679/  -  0.0584*  -  8.179.vlO~V  ~  9.347.vlO-3Hr  -3.942.rlirV 

-5  2  H4) 

-f  3.942.vlO  V$r-  0.2360 


/•  =  —6.553.x  lO"3//  +  6.767jrl0"4i-  -  6.767.tl0~3ur  -4.51  LrlO  ~6up 
— 1.631; vlO-5»/2iV 


4.076.vlO  5uv 

(45) 


Substituting  the  highest  derivative  terms  into  each  equation  and  alter  a  great  deal 
of  algebraic  work 

v  =  — 0.437»/r  +  0.027r//>  -  5.06.vl0_4»v  +  6.49.rl0'4n20r  -  2.3890  (46) 

p  =  0.02 1  ur  -  9.8.v  10~3t//*  -3.384.vl0~dnv  +  1.249.rlO_5M2«Sr  -  0.378</>  (47) 

r  =  —  7.2.vlO-3Mr  +  l.SxlO~5up  -3.888.vIO_5hv  -  1.595.rlO"5«J5r  -  4.094.x  10"\/)  (48) 


A.  DESIGN  SrECIFICATIONS 

In  general,  the  required  time  to  achieve  a  course  change  in  a  ship  depends  on 

1.  The  forward  speed, 

2.  The  difference  between  previous  and  commanded  course, 

3.  Applied  rudder  angle, 

4.  Rudder  area, 
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5.  The  length  and  hull  structure  of  the  ship. 

The  submerged  condition  is  also  a  very  important  aspect  since  the  required  turning 
time  is  about  three  times  greater  for  a  submerged  submarine  than  a  surfaced  one.  Espe¬ 
cially  at  lower  speeds,  it  is  very  hard  to  achieve  the  desired  course  for  a  submerged  sub¬ 
marine. 

It  is  concluded  that  for  the  speeds  which  are  less  then  10  Kts.,  a  control  system  must 
achieve  every  10  degrees  course  change  in  30  seconds.  This  allows  9  minutes  to  complete 
a  180  degrees  turn  and  it  is  very  reasonable  for  a  low  speed  submerged  submarine.  For 
higher  speeds  this  time  limit  would  be  20  seconds.  It  is  also  considered  that  more  than 
2.5  degrees  overshoot  is  not  acceptable. 

The  mechanical  limit  angle  for  rudder  is  also  35  degree  and  has  to  be  considered  in 
the  design  process. 

B.  DESIGN 

The  cascade  compensation  method  will  be  used  for  the  horizontal  motion.  Since  the 
aim  of  this  chapter  is  to  design  a  basic  steering  control,  the  roll  response  will  not  be  in¬ 
vestigated.  The  yaw  response  to  the  rudder  is  the  only  input-output  relation  of  interest 
at  this  point.  Figure  75  represents  a  control  model  for  the  horizontal  motion. 

A  signal  flow  graph  is  given  on  Fig.  76  for  the  linearized  equations  of  horizontal 
motion.  The  corresponding  numbers  for  symbols  in  the  flow  graph  are  given  below: 
a  =  0.437m 
b  =  0.027u 
c  —  —  5.0.tl0_4M 
</=  6.5.t  10- V 
e  =  -2.39 
/-0.021k 
g  =  — 9.8.x  10"3m 
h  =  -3.4.tl0-4u 
<=  1.25jrlO*5uJ 
>=  -0.378 
k  =  -7.2.tlO-3u 
/=  -7.8.x- 10-'h 
m  =  —  3.9.tlO'5M 
n  —  —  I.6.tl0-!« 
o  =  -4.1.X-10 -3 
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Figure  75.  Cascade  Compensated  Control  Model  for  Horizontal  Motion 


1.  Decoupling 

Since  this  signal  flow  graph  creates  13  loops  to  be  handled,  it  is  considered  to 
take  u  as  10  ft./sec.  at  the  beginning  of  the  calculation  in  order  to  reduce  the  amount 
of  required  algebraic  work. 

Applying  Mason's  gain  rule  to  the  signal  flow  graph  given  in  Fig.76,  the  input- 
output  relation  for  yaw  will  be  as  follows 

jw'  ^  —  l.dxHrV—  5Ay10“V— 6.8.rl0"ss-6.5.vl0_6 

— : —  =  u„  = - : - ; - ; - ,  , - 

dr  P  s 5  +  0.175jj  +0.3885j3  +0.022.C  -5.77.rlO"5s 

In  factorized  form,  the  same  equation  will  be 

,  —  l.(j.vlO~J(s  +  0.1 176  +  j0.6222){s  -1-  0.1176  -  j0.6222)(s  +  0.102) 

_  s{s  +  0.0587  +  />.6152K5  +  0.0587  ->0.6152)(s  +  0.0602)fs  -  0.0025)  } 


As  can  be  seen  from  the  transfer  function,  there  is  a  real  pole  in  the  right  half 
plane  which  is  very  near  to  the  origin.  The  characteristic  equation  roots  are 
— 0.05S+/0.615 
-0.O18+/0.020 
-0.1 
-0.022 
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Figure  76.  Signal  Flow  Graph  for  Horizontal  Equations  of  Motion 


The  root  locus  plot  anil  open  loop  Bode  plot  for  G,  are  given  in  Fig.s  77  and 
78. 

The  root  locus  plot  shows  that  there  is  a  very  small  gain  range  where  the  system  is  sta¬ 
ble.  The  Bode  plot  also  agrees  that  the  system  is  unstable  with  15  degrees  negative  phase 
margin  and  there  really  is  a  small  gain  range  over  which  the  system  will  be  stable  with 
a  small  damping. 

Since  it  is  obvious  that  a  gain  adjustment  will  not  be  enough  to  get  the  desired 
response  out  of  the  system,  the  cascade  compensation  will  be  required.  In  order  to 


IU0 


figure  77.  Root  Locus  Plot  for 


yaw 

~JT 


OPEN  LOOP  BODE  FOR  YAW/OR 
NO  COMPENSATOR 


increase  phase  margin  a  first  order  lead  compensator  is  to  be  added  to  the  forward  path. 
Using  cascade  compensator  design  techniques,  the  first  trial  would  be 


O.l  s  +  0.01  _  .Q  (a +  0.01) 
Sc~  0.01  4  +  0.1  “  i +  0.1 


(51) 


There  will  be  no  gain  adjusment  at  this  point. 

The  Bode  plot  for  the  compensated  system  is  given  in  Fig.  79.  The  phase  margin 
is  40  degrees  and  that  is  about  the  maximum  phase  which  can  be  acquired  with  only  one 
cascade  compensator.  The  root  locus  plot  shows  that  the  compensator  has  moved  a  lot 
of  root  locations  to  the  left  half  plane  and  it  is  given  in  Fig.  80. 

Since  the  root  locus  and  Bode  plots  show  very  reasonable  damping  and  stability, 
it  is  considered  that  the  compensated  system  is  ready  for  the  simulation.  The  DSL  sim¬ 
ulation  program  which  is  used  for  the  validation  of  the  linear  model  (Appendix  E),  is 
updated  with  the  designed  cascade  compensator.  This  program  is  given  in  Appendix  G 
including  required  modifications. 

2.  Simulation 

The  same  plane  actuators  which  were  used  for  the  stern  and  bow  planes,  are 
used  for  the  rudder  in  the  simulation  program.  But  since  the  input  is  totally  different,  it 
is  necessary  to  design  a  different  criteria  for  the  limiter.  The  first  run  was  made  without 
any  limiter,  then  using  trial  and  error,  the  best  limiter  choice  is  appeared  to  be: 

lim  =0.070  when  u  <  12  Kts. 

lim  =0.050  when  12  <  u  <  IS  Kts. 

lim  =0.035  when  u  >  18  Kts. 

The  complete  model  which  is  used  in  the  simulation  program  is  given  in  Fig.  81. 

Test  run  results  which  were  achieved  with  different  sets  of  speed  and  course,  are 
given  in  Figures  82  to  90.  The  roll  response  is  also  given  in  order  to  make  sure  that 
submarine  does  not  exceed  maximum  allowable  roll  limits.  Each  run  is  explained  briefly 
below: 

Run  No.  1: 

Using  6  Kts.  forward  speed  and  10  degrees  course  change,  the  maximum  re¬ 
quired  rudder  angle  was  82  degrees.  Therefore  it  is  necessary  to  use  a  limiter  on  the  error 
signal. 
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Figure  79.  Open  Loop  Bode  Plot  for  G.C». 


Figure  80.  Root  Locus  Plot  for  G.G, . 
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Figure  81.  Block  Diagram  lor  Compensated  Linear  Model  in  Horizontal  Motion 


Run  No.  2: 

Using  the  limiter  which  was  mentioned  above  and  for  IS  degrees  course  change, 
the  maximum  required  rudder  was  33  degrees.  It  takes  46  second  to  get  15  degrees  course 
alteration  with  only  2.5%  overshoot. 

Run  No.  3: 

This  time  the  system  is  tested  with  the  same  speed  for  a  90  degree  course  change 
which  is  one  of  the  commonly  used  commands  in  a  submarine.  It  takes  214  sec.  to  ex¬ 
ecute  this  command  which  is  in  the  specified  limits.  The  overshoot  is  1.5%  and  maxi¬ 
mum  required  rudder  angle  is  also  33  degrees. 

Rm  No.  4: 

In  order  to  get  the  speed  range  in  which  the  compensated  system  stays  in  the 
required  specifications,  the  forward  speed  is  increased  to  10  Kts.  For  a  15  degree  course 
change  the  time  to  execute  the  command  is  22  sec  with  1.9  feet  overshoot. 

Run  No.  5: 

For  90  degrees  course  change  with  10  Kts.  forward  speed  the  time  to  execute  the 
command  is  103  sec.  with  1.5%  overshoot.  Maximum  required  rudder  angle  is  still  33 
degrees.  As  can  aiso  be  seen  from  Fig.  86  the  maximum  roll  is  about  3  degrees. 
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Runs  No.6  and  7: 

These  runs  were  made  with  15  Kts.  forward  speed  for  15  and  90  degrees  course 
changes.  While  the  required  time  decreases  with  increasing  speed,  the  overshoot  in¬ 
creases.  But  the  results  are  still  in  the  specification  limit  as  can  be  seen  from  Fig.s  S7  and 
88.  flic  maximum  roil  angle  is  5  degrees  for  15  Kts.  forward  speed  which  is  also  rea¬ 
sonable.  The  maximum  required  rudder  angle  is  23  degrees  for  this  case. 

Runs  No.  8  and  9: 

These  runs  were  made  with  20  Kts.  forward  speed  also  dictated  the  speed  range 
for  the  compensated  system  because  it  becomes  too  oscillator}1  after  20  Kts.  which  is  not 
desirable.  It  is  necessary  to  add  another  cascade  compensator  to  the  forward  path  in 
order  to  get  enough  damping  for  speeds  higher  than  20  Kts.  It  is  to  be  noted  that  using 
a  limiter  also  helps  to  keep  the  roll  angles  small.  In  this  case  the  maximum  rudder  angle 
is  only  16  degrees  because  of  the  limiter  effect.  With  this  limited  rudder  angle  the  maxi¬ 
mum  roll  is  only  8  degrees.  Even  though  it  is  not  intended  to  control  the  roll,  the  limiter 
supplies  an  indirect  control  on  the  roll  response. 

Finally  it  is  considered  that  the  designed  automatic  control  for  the  linearized 
horizontal  motion  using  cascade  compensator  design  techniques,  is  satisfactory  for  the 
speed  range  of  6  to  20  Kts.  This  design  should  be  checked  in  the  actual  non-linear  sys¬ 
tem. 
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OROCREO  YAW  -  10  DEGREES 
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Figure  82.  Yaw  and  Roll  Response  to  10  Degree  Course  Change.  No  Liiniler 
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Figure  85.  Yaw  ami  Roll  Response  to  15  Degree  Course  Change.  U  =  10  Ivts, 


111 


PLANE  ANGLE  (DECREE}  YAW  AND  ROLL 
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Figure  86.  Yaw  and  Roll  Response  to  90  Degree  Course  Change.  U  =  10  Kts. 
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PLANE  ANGLE  (DEGREE)  YAW  AND  ROLL 


ORDERED  YAW  -  DO  DEGREES 


U  -  15  KTS 


Figure  88.  Yaw  and  Roll  Response  to  90  Degree  Course  Change.  U  =  15  Kts. 
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V.  VALIDATION  OF  THE  COMPENSATED  NON-LINEAR  MODEL 


The  main  purpose  of  this  study  was  to  show  that  it  is  possible  to  design  a 
compensator  based  on  the  linearized  version  of  a  non-linear  model  and  then  to  com¬ 
pensate  the  actual  non-linear  model  with  this  designed  compensator.  In  the  previous 
chapters  the  required  compensators  were  designed  for  the  linear  models  on  vertical  and 
horizontal  motions.  These  compensators  had  to  be  checked  with  the  actual  non-linear 
model  to  see  that  the  system  will  really  work  with  them. 

The  complete  DSL  simulation  program  for  the  non-linear  model  was  already  written 
and  used  by  Ref.  3  and  Ref.  5.  It  is  also  used  for  this  study  to  compare  linearized  models 
with  the  non-linear  model.  In  order  to  check  the  validity  of  automatic  control  systems, 
the  DSL  simulation  program  is  to  be  modified  including  the  compensator  and  limiter 
algorithms  in  it.  The  modified  version  of  the  DSL  program  for  the  compensated  non¬ 
linear  model  is  given  in  Appendix  I. 

A.  SIMULATION 

For  the  test  runs  to  check  the  designed  compensators,  the  same  limiter  values  arc 
used.  Since  the  actual  and  commanded  velocities  (  U  and  UC  )  arc  two  different  pa¬ 
rameters  and  U  is  always  somewhat  less  then  UC,  it  is  concluded  to  take  actual  speed 
U  as  the  parameter  for  the  limiters.  This  will  give  more  accurate  plane  deflections  de- 
pending  on  actual  forward  speed. 

The  non-linear  simulation  program  was  run  at  6,  10,  12,  15  and  20  Kts.  for  various 
depth,  pitch  and  yaw  commands.  A  diving  submarine  can  give  hundreds  of  maneuver 
variations  in  three  dimensional  motions.  Since  it  is  not  possible  to  include  all  of  them: 
only  the  most  common  conunands  and  the  commands  which  were  used  in  Chapter  2,3 
and  4  arc  included  for  comparison  purposes. 

The  trim  values  for  the  ordered  speed  arc  carefully  calculated  from  Ref.  5  and  im¬ 
plemented  in  the  non-linear  model. 

Test  run  results  which  were  achieved  for  different  sets  of  speeds  and  commands  arc 
given  in  f  igures  91  to  106.  Each  run  is  explained  briefly  below: 

Runs  No.  1-4: 

The  simulation  program  was  run  for  10  and  100  ft.  depth  changes  at  6  Kts.  com¬ 
manded  forward  speed.  As  can  be  seen  from  Fig.  91  the  non-linear  model  completes  a 
lo  ft.  depth  change  10  see.  after  the  linear  model  docs.  It  completes  a  loo  ft.  depth 
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change  20  see.  after  the  linear  model  and  overshoots  for  both  ease  arc  on  the  specifica¬ 
tion  limits.  There  is  also  a  1  ft.  steady  state  error  for  both  cases. 

At  the  same  speed  the  simulation  program  was  run  for  15  and  90  degree  course 
changes.  As  can  be  seen  from  Fig.  92  the  non-linear  model  takes  about  100  seconds  to 
achieve  a  15  degree  course  change  with  no  overshoot  and  a  slight  undershoot.  Also  the 
required  time  to  make  a  90  degree  course  change  is  more  than  360  seconds  for  the  non¬ 
linear  model.  These  two  case  are  also  non-acceptable. 

The  main  reason  for  this  failure  is  the  decreasing  forward  speed  due  to  the  plane 
deflections.  The  forward  speed,  depending  on  the  amount  of  the  rudder  deflection,  ac¬ 
tually  drops  up  to  4  Kts.  while  achieving  a  course  change  maneuver.  The  same  thing  also 
happens  for  a  depth  change  maneuver  due  to  the  stern  and  bow  planes.  The 
compensators  were  designed  for  actual  6  Kts.  and  higher  speeds  and  they  do  not  meet 
the  specifications  for  less  than  6  Kts.  forward  speed. 

Under  these  circumstances  no  more  investigations  were  made  at  6  Kts.  At  this  point 
it  is  concluded  to  operate  at  10  Kts. 

Runs  No.  5-8: 

As  can  be  seen  in  Fig.  93  the  non-linear  model  completes  a  10  ft.  depth  change  in 
42  seconds  with  I  ft.  overshoot  at  10  Kts.  It  completes  a  100  ft.  depth  change  in  106 
seconds  with  3.5%  overshoot.  These  numbers  satisfied  the  required  specifications  and 
♦'  iy  arc  nearly  the  same  as  for  the  linear  model  with  a  little  time  lag. 

As  can  be  seen  in  Fig.  94  the  non-linear  model  makes  a  15  degree  course  change  in 
25  seconds  with  0.8  degree  overshoot  which  is  less  than  the  linear  ease.  For  a  90  degree 
course  change  the  time  is  205  seconds  with  no  overshoot.  Again  due  to  the  rudder  drag 
force,  the  time  to  reach  the  commanded  course  is  much  larger  but  more  realistic  than  the 
linear  rase.  Since  the  constant  speed  assumption  which  is  used  for  the  linear  model  is 
no  longer  valid  for  large  perturbations,  this  is  really  expected.  On  the  other  hand  the 
dp"r  :d  cascade  compensators  can  still  control  the  actual  non-linear  system  cllectivcly 
cno  and  in  fact,  with  less  overshoot  which  is  very  important  from  the  point  of  this 
stud 

Runs  No.  9-  i  2: 

In  o  er  to  have  an  idea  about  speed  deviation  due  to  the  plane  deflections,  four 
runs  were  performed  for  10  and  100  feet  depth  change  and  15  and  90  degree  course 
change  ,u  10  Kts.  As  can  be  seen  in  Fig.  95  there  is  an  appreciable  difference  between 
the  drag  forces  created  by  rudder  and  bow,  stern  planes.  This  is  expected  since  the  rudder 
has  a  lot  more  surface  than  the  other  planes.  For  a  15  degree  course  change  the  forward 
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speed  drops  abruptly  to  9.3  Kts.  and  goes  back  to  it's  original  value  in  a  relatively  small 
time.  For  a  90  degree  course  change,  the  forward  speed  drops  up  to  9  Kts.  and  stnvs  al¬ 
most  constant  for  about  150  seconds  which  is  the  greatest  cause  lor  the  slower  course 
change  rate. 

Runs  No.  13  and  14: 

Since  the  linear  model  assumes  no  cross-coupling  between  vertical  and  horizontal 
motion,  these  runs  arc  performed  only  for  the  non-linear  model.  Cross-coupling  effects 
on  depth  and  pitch  angle  are  shown  in  Fig.  96  at  10  Kts.  for  15  and  90  degree  course 
change  commands.  For  both  commands,  the  submarine  stays  in  the  5  feet  depth  and  2 
degrees  pitch  error  limitations. 

Run  No.  15: 

One  of  the  most  difficult  maneuver  for  a  submarine  is  to  change  depth  while 
achieving  a  course  command.  Results  of  such  a  maneuver  arc  given  on  Fig.  97  and  Fig. 
98.  A  simulation  run  for  simultaneous  90  degree  course  and  100  It.  depth  change  com¬ 
mands.  shows  that  the  time  to  reach  90  degree  course  change  is  about  40  seconds  longer 
than  the  usual  condition  but  it  docs  not  alfcct  the  depth  change.  Because  of  the  rudder 
effect  only  a  small  depth  error  appears  until  the  submarine  settles  on  the  desired  course. 

As  can  be  seen  in  Fig.  98  the  non-linear  submarine  s  roll  and  pitch  responses  arc 
somewhat  non-regular  but  still  in  reasonable  limits  for  this  ease.  The  forward  speed  de¬ 
viation  due  to  the  plane  drag  forces  is  also  given  in  Fig.  98.  Speed  drops  up  to  8.3  Kts. 
and  this  gives  an  explanation  for  lower  course  change  rate. 

As  a  result  for  this  run.  even  though  the  designed  control  systems  interact,  they  can 
work  well  simultaneously. 

Runs  No,  16  and  17: 

In  order  to  be  able  to  compare  fixed  rudder  clTects  on  depth  and  pitch  angle,  two 
simulations  were  performed  for  15  degree  and  35  degree  fixed  rudder  commands  in  the 
same  fashion  as  in  Chapter  4  at  12  Kts.  For  15  degree  rudder  the  pitch  and  depth  errors 
stay  in  specified  limits  but  for  35  degree  rudder  these  errors  arc  not  allowable.  Simulation 
results  lor  this  case  arc  given  in  Fig.  99. 

Runs  No.  18  and  19: 

Figure  KM)  gives  the  simulation  results  for  a  15  and  a  90  degree  course  change  at  15 
Kts.  for  both  linear  and  the  non-linear  models.  The  yaw  response  for  15  degree  course 
change  is  almost  the  same  as  the  response  for  10  Kts.  with  a  little  more  overshoot  and 
oscillation.  On  the  other  hand  the  non-linear  model  shows  a  better  response  with  less 
overshoot  for  both  eases. 
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Runs  No.  20  and  21: 

Figure  101  gives  the  simulation  results  for  a  10  and  a  100  feet  depth  change  at  15 
Kts.  Surprisingly  there  is  almost  no  difference  between  linear  and  non-linear  model  for 
the  10  feet  depth  change.  But  for  the  100  A.  depth  change  the  non-linear  model  has  a 
faster  response  than  the  linear  model.  This  is  unusual  and  created  by  different  limiter 
behaviors  on  bow  planes  at  this  specific  forward  speed. 

Runs  No.  22  and  23: 

In  a  real  submarine  a  depth  change  command  usually  comes  with  a  pitch  command 
in  order  to  reduce  the  time  to  get  the  desired  depth.  Figure  102  gives  the  results  of  such 
a  command  for  100  feet  depth  change  with  5  degree  down  pitch  angle  at  6  and  15  Kts. 
For  both  cases  the  submarine  reaches  the  desired  depth  35  seconds  before  the  case  for 
which  no  pitch  command  is  given.  But  as  a  trade-off  the  overshoots  are  over  10%.  Also 
the  pitch  command  has  to  be  reduced  to  zero  before  the  desired  depth  is  reached  in  order 
to  avoid  too  much  overshoot  and  a  steady  state  error  on  depth.  This  is  done  10  feet 
before  the  desired  depth  is  reached,  for  6  Kts  and  50  feet  before  for  15  Kts. 

Runs  No.  24  and  25: 

Finally  the  compensated  non-linear  system  was  checked  at  20  Kts.  For  a  15  and  a 
90  degree  course  change,  the  yaw  responses  of  the  compensated  submarine  are  given  in 
Fig.  103.  Once  again  the  non-linear  model  gives  a  better  but  slower  response  then  the 
linear  model.  For  the  15  degree  course  change  the  yaw  responses  of  both  models  become 
too  oscillatory  due  to  the  high  speed.  But  the  compensator  still  works  well  enough  to 
control  the  submarine. 

Runs  No.  26  and  27: 

Figure  104  gives  the  compensated  submarine  depth  responses  for  a  10  and  a  100  feet 
depth  change  at  20  Kts.  There  is  a  0.8  feet  steady  state  error  for  both  cases  which  is 
created  by  the  system  dynamics  due  to  the  high  speed.  The  control  system  design  is 
bused  on  10  ft., 'sec.  (  6  Kts.)  forward  speed.  At  20  Kts.  the  transfer  functions  which 
describes  the  submarine  dynamics  might  have  very  different  characteristics.  Conse¬ 
quently  it  is  concluded  that  the  upper  speed  limit  for  this  design  is  20  Kts.  In  fact,  the 
control  system  works  up  to  25  Kts.  without  exceeding  design  specification  limits. 

The  compensated  submarine  pitch  responses  for  the  same  runs  are  given  in  Fig.  105. 
The  linear  and  non-linear  models  show  very  similar  pitch  behavior  and  pitch  angles  do 
not  exceed  the  given  2  degree  limit  even  for  this  high  speed. 

As  a  result  of  this  chapter  it  has  been  shown  that  the  designed  automatic  control 
system  for  the  linearized  model  can  also  work  effectively  on  the  actual  non-iincar  model. 
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100  FT.  DEPTH  CHANGE  UC  -  •  KTS. 


Figure  9i.  Compensated  Submarine  Depth  Responses  at  6  Kts. 
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Figure  92.  Compensated  Submarine  Yaw  Responses  at  6  Kts. 
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Figure  93.  Compensated  Submarine  Depth  Responses  at  10  Kts. 
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YMT  (DECREE)  YAW  {DECREE) 


IS  DEG.  COURSE  CHANGE  UC  -  10  KTS, 


Figure  94.  Compensated  Submarine  Yaw  Responses  at  10  Kts. 
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PITCH  ERROR  (DEGREE)  DEPTH  ERROR  (FEET) 


CROSS-COUPLING  EFFECT  ON  DEPTH  UC  ■  10  KTS. 


TIME  (SEC  ) 


CROSS-COUPLING  EFFECT  ON  PITCH  UC  -  10  KTS. 


Figure  96.  Cross-Coupling  EiTects  for  tiie  Non-Linear  Submarine  at  10  Kts. 
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CROSS-COUPLING  EFFECT  ON  DEPTH  U  -  12  KTS 


CROSS-COUPUNC  EFFECT  ON  PITCH  U  -  12  KTS 


Figure  99.  Depth  and  Pitch  Response  for  Fixed  Rudder  Commands  U=  12  Kts. 
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Figure  101.  Compensated  Submarine  Depth  Responses  at  15  Kts. 
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PITCH  max  (DECKED  OCTTO  CHMOC  (FCET) 


100  FT.  DCF1H  CHANGE  WITH  8  DEO.  WITCH  ANGLE 


0  100 


me  (see.) 


Figure  102.  Depth  Change  with  5  Deg.  Down  Pitch  Angle  for  Non-Linear  Sub. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS  FOR  FURTHER 

WORK 


A.  CONCLUSIONS 

The  linearization  of  given  non-linear  differential  equations  of  motion  in  six  degrees 
of  freedom,  designing  two  automatic  control  systems  using  cascade  compensator  design 
techniques  for  vertical  and  horizontal  motion  of  a  submarine  and  finally  investigating 
cross-coupling  elfects  due  to  the  rudder  deflections  were  the  main  concerns  in  this  study. 

It  has  been  shown  that  using  linearized  equations  to  design  an  automatic  control  for 
the  actual  non-linear  system  is  possible  for  the  submarine  problem.  Also  cascade  com¬ 
pensation,  using  a  single  loop  technique,  which  was  mainly  the  Bode  plot  design  in  this 
study,  is  possible  and  practical  for  automatic  pitch,  depth  and  yaw  control  of  small 
submarines. 

The  designed  control  systems  for  both  planes  satisfied  the  design  specifications  for 
a  speed  range  from  8  to  20  Kts.  That  means  the  compensated  system  is  rather  insensitive 
to  speed  deviations.  Therefore  all  problems  related  to  gain  switching,  like  cluttering  and 
discontinuities  in  plane  angles,  arc  avoided.  This  is  especially  important  because  the 
forward  speed  changes  significantly  during  maneuvers. 

The  implementation  of  the  designed  compensators  into  hardware  has  the  following 
desirable  features: 

1.  Minimal  Instrumentation:  Since  rate  information  is  not  required,  no  inertial  guid¬ 
ance  system  is  necessary.  Only  a  regular  gyro  for  course  and  simple  sensors  for 
depth  and  pitch  angle  are  needed. 

2.  Low  Cost,  Weight  and  Size:  The  simplicity  of  the  compensator  transfer  functions 
makes  them  easily  realizable  in  physical  hardware  at  low  manufacturing  cost. 
Weight  and  size  requirements  are  very  small,  another  important  factor  especially 
for  small  coastal  submarines.  A  wide  speed  range  is  covered  by  one  fixed 
compensator  and  no  changes  in  parameters  are  necessary. 

3.  Reliability:  The  automatic  controller  can  be  realized  with  a  set  of  physical  com¬ 
ponents  with  a  well  known  high  reliability.  High  component  reliability  and  a  small 
number  of  components  will  generally  result  in  a  high  system  reliability. 

B.  RECOMMENDATIONS  FOR  FURTHER  WORK 

1 .  The  designed  control  system  in  this  study  can  keep  the  pitch  and  depth  errors  in 
reasonable  limits  for  small  rudder  deflections  and  course  changes.  But  larger  deflections 
still  create  an  appreciable  amount  of  depth  and  pitch  error  at  high  speeds  which  is  not 
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desirable  for  near  surface  operations.  It  might  be  worthwhile  to  improve  this  design  to 
get  a  sufficient  control  on  cross-coupling  elTects  for  all  kinds  of  heavy  maneuvers.  This 
can  be  done  using  different  sets  of  parameters  for  the  compensators  and  limiters  and  or 
increasing  the  numbers  of  compensators  for  the  vertical  control  of  the  submarine. 

2.  In  some  operational  conditions  it  is  very  important  to  reach  a  desired  depth  as 
soon  as  possible  in  a  submarine.  Therefore  an  additional  pitch  angle  command  is  given 
which  has  an  enormous  effect  on  depth  change  rate.  For  the  present  design  it  is  possible 
to  give  both  depth  and  pitch  command  at  the  same  time  but  the  watch  olliccr  has  to 
decide  where  to  change  the  pitch  command  to  zero.  Otherwise,  depending  on  the  forward 
speed  and  commanded  pitch  angle,  the  submarine  might  not  stay  on  desired  depth. 

The  present  design  can  be  modified  using  a  new  algorithm  which  can  decide  where 
and  in  what  fashion  to  decrease  the  pitch  angle  automatically  in  order  to  get  desired 
depth  and  stay  there  without  any  unacceptable  overshoot  and  steady  state  error. 
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APPENDIX  A.  DEFINITIONS  OF  SYMBOLS 

DEFINITION 

A  dot  over  any  symbol  signifies  differentiation 
with  respect  to  time. 

Buoyancy  force  which  is  positive  upwards. 

Mass  of  the  submarine  including  the  water  in  the 
free  Boating  spaces. 

Overall  length  of  the  submarine. 

Linear  velocity  of  origin  of  body  axes  relative 
to  an  earth-fixed  axis  system. 

Component  of  U  along  the  body  x-axis. 

Component  of  U  along  the  body  y-axis. 

Component  of  l!  along  the  body  z-axis. 

Command  speed. 

Longitudinal  axis  of  the  body  fixed  coordinate 
axis  system. 

Transverse  axis  of  the  body  fixed  coordinate 
axis  system. 

Vertical  axis  of  the  body  fixed  coordinate  axis 
system. 
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jr0  Distance  along  the  x  axis  of  an  earth-fixed 

axis  system. 

Distance  along  the  y  axis  of  an  earth- fixed 
axis  system. 

2„  Distance  along  the  z  axis  of  an  earth-fixed 

axis  system. 


P 

q 

r 

zB 

a. 

P 

6b 

6r 

6b 

n 

e 


Component  of  angular  velocity  about  the  body 
fixed  x-axis. 

Component  of  angular  velocity  about  the  body 
fixed  y-axis. 

Component  of  angular  velocity  about  the  body 
fixed  z-axis. 

The  z  coordinate  of  the  center  of  buoyance 
(  CB  )  of  the  submarine. 

Angle  of  attack. 

Angle  of  drift. 

Deflection  of  bow  or  fairwater  planes. 
Deflection  of  rudder. 

Deflection  of  stern  planes. 

The  ratio  -j- . 

Pitch  angle. 
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Yaw  angle. 


W, 


(O 

t 

*« 


(a 


/. 


Roll  angle. 

Mass  density  of  sea  water. 

Weight  of  water  blown  from  a  particular 
ballast  tank  identified  by  the  integer  assigned 
to  the  index  i. 

Angular  velocity. 

Time. 

Location  along  the  body  x-axis  of  the  center 
of  mass  of  the  i*  ballast  tank  when  this  tank  is 
filled  with  sea  water. 

Propulsion  force. 

Moment  of  inertia  of  a  submarine  about  the 
x-axis. 


Iy  M  oment  of  inertia  of  a  submarine  about  the 

y-axis. 

/,  Moment  of  inertia  of  a  submarine  about  the 

z-axis. 

All  K  ’s  Non-dimensional  constants  each  of  which  is  assigned 

to  a  particular  force  term  in  the  equation  of  motion 
about  the  body  x-axis. 

All  M  's  Non-dimensional  constants  each  of  which  is  assigned 

to  a  particular  force  term  in  the  equation  of  motion 
about  the  body  y-axis. 
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All  N's 


All  X's 


All  Y's 


All  Z's 


Non-dimensional  constants  each  of  which  is  assigned 
to  a  particular  force  term  in  the  equation  of  motion 
about  the  body  z-axis. 

Non-dimensicnal  constants  each  of  which  is  assigned 
to  a  particular  force  term  in  the  equation  of  motion 
along  the  body  x-axi$. 

Non-dimensional  constants  each  of  which  is  assigned 
to  a  particular  force  term  in  the  equation  of  motion 
along  the  body  y-axis. 

Non-dimensional  constants  each  of  which  is  assigned 
to  a  particular  force  term  in  the  equation  of  motion 
along  the  body  z-axis. 


APPENDIX  B.  HYDRODYNAMIC  COEFFICIENTS  OF  SIMULATION 

EQUATIONS 

A.  AXIAL  FORCE 


XQQ 

= 

-0.000200 

XRR 

=  -0.000090 

XRP 

0.000250 

XU  DOT 

= 

-0.000150 

XVR 

=  0.011000 

XWQ 

-0.007500 

XUU 

- 

0.0 

XVV 

-  0.006500 

XDRDR  = 

-0.002800 

XDSDS 

r= 

-0.002500 

XDBDB 

=  -0.002600 

XVVN  - 

0.0 

XWWN 

= 

0.0 

XDR2N 

=  0.0 

XDS2N  = 

0.0 

B. 

LATERAL  FORCE 

YP/P/ 

= 

0.0 

YPQ 

-  0.000200 

YPDOT  * 

-0.000300 

YRDOT 

= 

0.000090 

YVDOT 

-  -0.011000 

YV/R  /  = 

-0.007300 

YWP 

= 

0.007500 

YR 

=  0.003000 

YRDR  - 

0.0 

YP 

a 

-0.000700 

YUU 

*  0.0 

YV/V/  * 

-0.060000 

YV 

a 

-0.021000 

YDR 

-  0.006200 

YWV 

-0.065000 

YVS 

- 

0.0 

YRN 

-  0.0 

YVN 

0.0 

YVAVN 

— 

0.0 

YDRN 

“  0.0 

C. 

NORMAL  FORCE 

ZRR 

a 

-0.001500 

ZRP 

=  -0.000900 

ZQDOT  = 

-0.000200 

ZVVDOT 

a 

-0.007500 

ZVR 

=  -0.008000 

ZVV/Q/  - 

-0.006000 

ZQ 

= 

-0.004500 

ZQDS 

-  0.0 

ZVP 

-0.007000 

zuu 

a 

-0.000100 

ZW 

-  0.000650 

ZW/W/  = 

-0.030000 

zw 

a 

-0.011000 

ZDS 

=  -0.005000 

ZDB 

-0.002500 

Z/W/ 

a 

0.0 

ZWW 

=  0.0 

ZVS 

0.0 

ZQN 

a 

0.0 

ZWN 

=  0.0 

ZWAWN  = 

0.0 

ZDSN 

a 

0.0 

Z  +  VP 

=  0.0 
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D.  ROLLING  MOMENT 


KP.'P; 

=  -0.0000008 

KQR 

= 

-0.000100 

KPDOT 

ss 

-0.000003 

KRDOT 

=  -0.000007 

KVDOT 

a 

-0.000250 

KWP 

- 

0.000250 

KR 

=  -0.000040 

KP 

= 

-0.000035 

KUU 

8 

0.0 

KV/V/ 

=  -0.000900 

KV 

- 

-0.000700 

KDR 

8 

0.000070 

KWV 

-  0.003500 

PITCHING  MOMENT 

MRR 

=  -0.0005500 

MRP 

s 

0.000150 

MQDOT 

8 

-0.000400 

M  +  RP 

-  0.0 

MWDOT 

= 

-0.000200 

MVR 

8 

-0.002000 

M/W/Q 

=  -0.002000 

MQ 

= 

-0.002500 

MQDS 

= 

0.0 

MVP 

=  0.000900 

MUU 

= 

0.000040 

MW 

8 

0.015000 

MW/VV  / 

«  -0.005000 

MW 

= 

0.003000 

MDS 

8 

-0.002500 

MDB 

=  0.000500 

M/W  / 

8 

0.0 

MWW 

= 

0.0 

MQN 

=  0.0 

MWN 

= 

0.0 

MWAWN- 

0.0 

M  DSN- 

=  0.0 

YAWING 

MOMENT 

NPQ 

=  -0.0004000 

NPDOT 

8 

-0.000007 

NRDOT 

8 

-0.000500 

NVDOT 

=  0.000300 

N/V/R 

8 

-0.004500 

NWP 

8 

-0.000200 

NR 

=  -0.003000 

NRDR 

8 

0.0 

NP 

8 

-0.000005 

NUU 

=  0.0 

NV/V/ 

= 

0.014000 

NV 

8 

-0.007500 

NDR 

-  -0.003000 

NWV 

0.015000 

NRN 

= 

0.0 

NVN 

-  0.0 

NVAVN 

8 

0.0 

NDRN 

8 

0.0 

OTHERS 

A1 

-  -0.001000 

A2 

8 

-0.000950 

A3  ' 

8 

0.001950 

LC 

-  415.0 

ML 

8 

0.0087445 

BZB 

8 

0.0010114 

IX 

-  7.31  Ijc10_# 

IY 

8 

5.6867jc10-4 

IZ 

8 

5.6867.r  10 
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APPENDIX  C.  STANDARD  EQUATIONS  OF  MOTION 


A.  AXIAL  FORCE 

m(u  -  vr  +  wq)  -  y  f\_Xqqq2  +  Xrrr2  +  Xrprp] 

+  y  l3LXuu  +  Xnvr  +  Xwqwq] 

+  y  iXxmu2  +  Xvvv2  +  X^w7] 

+  y  Mlx^y  +xMsSs7  +  w*2] 
+  j-t2XU"-  l)vJ 

+  y^wwn(»-Dw2 
+  y  l7u7Xis6sn{n  —  1)<52 

+7/VW»-i)^ 

-lysine 

+ 
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B.  LATERAL  FORCE 


m(v  -  wp  -I-  i/r)  -  y  /*[  jy  4-  Yf] 

+T/4|:i>9+  }W^I3 

+  f  />[  >'*»  +  1>?  +  f*  -jjj-  Kv:  +  w!)f||r|] 

+  y/’[l>+  >'w*i'W«r+  >>] 

+  l)ur 

+y/:[  J-.y  +  >>  +  r^vKt* + w!)i|] 

+  y  /JuJ  YsubSrSr 
+  -jlVran(n-l)S, 

+  y  *)««■ 

+ V. 


+  E^sin  0  cos  0 


C.  NORMAL  FORCE 


m(vv  —  uq  +  vp)  —  *y /*  Z^q 

+  -§-/4[Z^  +  Zy/.] 

-  +4-/3[Z*t»'  +  Zlrw'  +  Zvvp  +  AZvvp] 

+  •§■  /"[z,*,  +  Zk|4tui,|iS  +  Z*,  -j*j- !(»’  +  w*)+iw] 

+  -|l3Z„,(»-l)“? 

+  4-  /’[z„,u!  +  Zjm  +  ZW(W|H('1  +  tv1)  J  |] 

+  /![ZW»H  +  Z..H*1  +  w’jIlZ,,..2] 

+  -|/,CZj,<5j  +  Z»M] 

+  y  /![z„(<.  -  l)<™  +  ZHw„(n  -  IKK.1  +  wJ)i|] 

+  -§-/Vzta(»-  !)fc 

.  P  a,  w  x  V2  +w2 
+  -y *  (^z)vj  — (7 —  V  sin  «/ 

+  £W'i<:os$cos0 
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D.  ROLLING  MOMENT 


tjP  +  (I,  -  Iy)qr  -  y  t'lKpP  +  Kqtqr  + 

+  y  fZKpttp  +  KfUr  +  K+v  +  Kwp\vp] 

+  j-  /*[  Kmu2  +  Kjn  +  K^v  |(vJ  +  wJ)i|] 

+  y/3  A'wm 
+  -§-/V**<5r 
+  B  sin  <f>  cos  0 


i 
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E.  PITCHING  MOMENT 


Iyq  +  Ux  -  h)rP  “  y  /S[^  +  K/  +  Kprp  +  AMvr/»] 

+  y  +  M\q\isuWs  +  A/,wkl(v2  +  «-J)i|«7] 

+  y  ^[A/^w  +  A/Wvr  +  A/^vp] 

+  -^/4A/,fl(«-l)«9 

+  y  /3[a7miim2  +  Mwuw  +  A/w.n»v|(v2  +  w2)i|] 

+  y  /3[a/muM  +  A/wJiv(v2  +  w2)  2 1  +  A/Vvv2  J 

+  y/3CA/&A5  +  A/^6] 

+  y  /3A twn(n  -  1)«W 

+  y  Z3 A/Hwjn(rt  -  l)w|(v2  +  vv2)i| 

+  y  l3u2M6s„(n  -  1)(5j 
+  Bzb  sin  6 


+  Z  cos  4>  cos  0 


F.  YAWING  MOMENT 


+  Uy  -  /,)/></  -  y  /5C<V  +  A>«/  +  A^] 

+  y  ^[a>‘  +  A^i/lrl^r  +  ArMr|(v2  +  u-i)i|r] 
+  y  /*[  A'pf//>  +  A>  +  Nwpwpl 
+  y  ^ AV„(«  -  I)"'' 

+  y  ^[a^i/2  4-  Avmv  +  A?V|V|V|(v2  4-  u  2)  2 1 J 
+  ■y  /3«J  Ar^r 
+  y  l3u2X6rn(n  -  1  )«5r 
+  y/3A,vn(«-l)Mv 

+  y  /3A\|v|n(M  -  i)v|(»a  +  wJ)i| 

+  y  Pi\wvwv 


+  X  H>Yr/  s*n  0  COS  0 


G.  AUXILARY  EQUATIONS 


0  —  ^  sin  0 


0  - 


q  —  \jt  cos  0  sin  ^ 
cos  ^ 


r  +  0  sin  0 
cos  4>  cos  0 


x0  =  w  cos  0  cos  \Jr  +  v(  sin  0  sin  0  cos  ^  —  cos  4>  sin 
+  w{  sin  <f>  sin  \Jt  +  cos  0  sin  0  cos 

j’o  =  m  cos  0  sin  ^  +  v(  cos  0  cos  ^  +  sin  <f>  sin  0  sin  0) 
+  w(  cos  <(>  sin  0  sin  ^  -  sin  0  cos 


i0  =  -u  sin  0  +  v  cos  0  sin  <j>  +  w  cos  0  cos  </> 


(Ft)p  =  y  /V[«i  +  +  fl3«2] 
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APPENDIX  D.  SIMULATION  PROGRAM  FOR  LINEARIZED 


VERTICAL  EQUATIONS  OF  MOTION 

*  THIS  PROGRAM  SIMULATES  THE  LINEARIZED  SUBMARINE  EQUATIONS 

*  IN  THE  VERTICAL  PLANE. 

* 

★ 

TITLE  SUBMARINE  EQUATIONS  FOR  THE  VERTICAL  PLANE 
* 

*  AXIAL  SPEED 
CONST  U=8. 445 
INITIAL 

DS=0. 0 
DB=0. 0 
DERIVATIVE 

DB-O. 0*STEP(0) 

DS=0. 0*STEP(0) 

THETA=INTGRL(0.  08726, Q) 

DEPTH  =  INTGRL(.O.ZDOT) 

Q=INTGRL( .  0 ,QDOT) 

ZDOT=INTGRL( -0.  736 , ZDDOT) 

Yl— 1.  728E-3*U*ZDOT 
Y4=-0.  706*U*Q 

Y5=(0.  0128-(1.  728F.-3)*U*U)*THETA 

Y2=-6.  667E -4*U*U,VDS 

Y3=-3.  8 7 3E - 4*U*U*DB 

ZDDOT=Y 1+Y2+Y3+Y4+Y5 

Y0=1. 884E-5*U*ZD0T 

Y9=-6,  365E-3*U*Q 

Y6=3. 193E-6*U*U*DB 

Y7=-1.465E-5*U*U*DS 

Y8=( ( 1. 884E-5)*U*U-2.  522E-3)*THETA 

QDOT=Y  0+Y8+Y6+Y  7 + Y9 

DEP=INTGRL( . 0 , ZDOT) 

CONTROL  FINTIM=360 
PRINT  1.  , THETA .DEPTH, ZDOT 
SAVE  0.  1 ,W , ZDOT , THETA , DEP 
GRAPH(DE=TEK618)TIME, THETA, DEP 

LABEL  INITIAL  CONDITION  RESPONSE  iN.  PITCH=5  DEG.  U=5  KTS. 
GRAPH( DE=TEK618)TIME , ZDOT 

LABEL  INITIAL  CONDITION  RESPONSE  IN.  PITCH=5  DEG.  U=5  KTS. 


APPENDIX  E.  SIMULATION  PROGRAM  FOR  LINEARIZED 


HORIZONTAL  EQUATIONS  OF  MOTION 

*  THIS  PROGRAM  SIMULATES  THE  LINEARIZED  SUBMARINE  EQUATIONS 

*  IN  THE  HORIZONTAL  PLANE. 

* 

* 

* 

TITLE  SUBMARINE  EQUATIONS  FOR  TJ!E  HORIZONTAL  PLANE 
* 

*  AXIAL  SPEED 
CONST  U=30. 4 
INITIAL 

DR=0. 0 
DERIVATIVE 

Yl*l.  89*RDOT 
Y2=-6.  3*PDOT 
•  Y3=-0. 291*U*R 

Y4«-0.  035*U*P 
Y5=-2.  563E-3*U*V 
Y6=7.  568E-4*U*U*DR 
VDOT=Y 1+Y2+Y3+Y4+Y5+Y6 
Y7=-0.  679*RD0T 
Y8=-0.  0584*VDOT 
Y9=-9.  347E-3*U*R 
Y10=-8.  179E-3*U*P 
Yll=-3.  942E-4*U*V 
Y12=3.  9 4 2E - 5*U*U*DR 
Y13=0.  236*PHI 

PD0T='Y7+Y8+Y9+Y10+Y11+Y12-Y13 

Y14=-6.  553E-3*PDOT 

Y15-6, 767E-4*VD0T 

Y16«-6. 767E-3*U*R 

Y17--4.  511E-6,VU*P 

Y18=-4. 076E-5*U*V 

Y19=-l. 631E-5*U*U*DR 

RD0T=Y14+Y15+Y16+Y17+Y18+Y19 

P=INTGRL(.  0 ,PD0T) 

V=INTGRL(.  O.VDOT) 

R=INTGRL(.  O.RDOT) 

*  PHI=INTGRL( 0.  43633 ,P) 

PHI=INTGRL(0.  0,P) 

XI=INTGRL( .  0,R) 

DYNAMIC 

IF(TIME.  GE.  10)  DR  =  0.611 
IF(TIME.GE.  40)  DR  =  -0.611 
IF(TIME.GE.  70)  DR  -  0. 0 
DRDEG  =  DR*5  7 . 296 
ROLDEG=  PH 1*5 7. 296 
YAWDEG=  XI,V57.  296 
CONTROL  FINTIM=360 
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PRINT  1. , V , YAWDEG , ROLDEG 

SAVE  0.  1 , V , YAWDEG , ROLDEG , DRDEG 

GRAPH( DE=TE^6 1 8 )TIME , YAWDEG , ROLDEG 

LABEL  FORCED  RESPONSE  TO  35  DEG.  RUDDER  U=18  KTS. 


l 


APPENDIX  F.  SIMULATION  PROGRAM  FOR  THE  COMPENSATED 


SYSTEM  IN  VERTICAL  MOTION 

*  THIS  PROGRAM  SIMULATES  THE  COMPENSATED  SUBMARINE  MOTIONS 

*  IN  THE  VERTICAL  PLANE. 

* 

* 

* 

TITLE  SUBMARINE  SIMULATION 
PARAM  K1  =  0.  015 
PARAM  K2  ■  2.  0 
PARAM  UC  =  10.  4 
PARAM  Z0R=  100. 

PARAM  POR=  0.  0 

it 

DERIVATIVE 

PITCH=INTGRL(0.  0,Q) 

DEPTH  =  INTGRL(.O.ZDOT) 

Q=INTGRL( .  0 ,QD0T) 

ZD0T=INTGRL(-0.  736.ZDD0T) 

Yl=-1. 728E-3*U*ZD0T 
Y4=-0. 706*U*Q 

Y5«(0.  0128-C1.  728E-3)*U*U)*PITCH 

Y2=-6. 667E-4*U*U*DS 

Y3=-3.873E-4*U*U*DB 

ZDD0T=Y1+Y2+Y3+Y4+Y5 

Y0=1. 884E-5*U*ZDOT 

Y9=-6. 365E-3*U*Q 

Y6=3. 193E-6*U*U*DB 

Y7=-l. 465E-5*U*U*DS 

Y8=( ( 1.  884E-5)*U*U-2. 522E-3)*PITCH 

QDOT=Y  0+Y8+Y6+Y  7+Y9 

DEP=INTGRL( .  0 , ZDOT) 

ZER  =  ZOR  -  DEPTH 
PER  =  POR  -  PITCH 
ZERR=  LIMIT( -LIM ,LIM,ZER) 

PERR=  LIMIT(-IIM,LIM,PER) 

DYNAMIC 

IF(UC. LT.  15. )  LIM  =  35. 

IF(UC.  GE.  15.  )  LIM  *  25 
IF(UC. GE. 25.  )  LIM  ■  15. 

♦COMPENSATOR  GC11 

Cll  ■  -K1*ZERR 

C12  =  LEDLAG(0.  ,1.0,0.  1, Cll) 

DB  =  REALPL(0.  ,. 667.C12) 

♦COMPENSATOR  GC22 

C21  =  -K2*PERR 

DS  =  REALPL(0.  ,.  667, C21) 

DSDEG  =  57. 296*DS 
DBDEG  =57. 296*DB 
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PITDEG  =  57.  296*PITCH 
CONTROL  FINTIM=360 

SAVE  0.  1, DEPTH, ZDOT, PITDEG, DSDEG.DBDEG 

PRINT  1.  .PITDEG, DEPTH, ZDOT, DSDEG.DBDEG 
GRAPH(DE=TEK618)TIME, PITCH, DEPTH 
LABEL  100  FT.  DEPTH  CHANGE  U=6  KTS. 
GRAPH( DE=TEK6 1 8 ) DBDEG , DSDEG 
LABEL  100  FT.  DEPTH  CHANGE  U=6  KTS. 


APPENDIX  G.  SIMULATION  PROGRAM  FOR  THE  COMPENSATED 

SYSTEM  IN  HORIZONTAL  MOTION 

*  THIS  PROGRAM  SIMULATES  THE  COMPENSATED  SUBMARINE  MOTIONS 

*  IN  THE  HORIZONTAL  PLANE. 


TITLE  SUBMARINE  SIMULATION  FOR  THE  HORIZONTAL  PLANE 

* 

PARAM  K1  -  1.00 
PARAM  LIM  »  0.  065 
PARAM  U  -  30.4 
PARAM  ORYAW-O.  2618 

DERIVATIVE 

Yl=l. 89*RD0T 
Y2=-6. 3*PDOT 
Y3=-0. 29 1*U*R 
Y4=-0. 035*U*P 
Y5=-2.  563E-3*U*V 
Y6=7. 568E-4*U*U*DR 
VD0T=Y1+Y2+Y3+Y4+Y5+Y6 
Y7=-0. 679*RD0T 
Y8*-0. 0584*VD0T 
Y9=-9. 347E-3*U*R 
Y10=-8.  179E-3*U*P 
Yll=-3.  942E-4*U*V 
Y12=3. 942E-5*U*U*DR 
Y13=0.  236*FHI 

PDOT=Y  74 Y  8+Y9+Y 10+Y 1 1+Y 1 2 - Y 1 3 

Y14=-6.  553E-3*PDOT 

Y15=6. 767E-4*VDOT 

Y16=*-6.  767E-3*U*R 

Y17=-4.  511E-6*U*P 

Y18=-4.  076E-5*U*V 

Y19=-l. 631E-5*U*U*DR 

RDOT=Y14+Y15+Y16+Y17+Y18+Y19 

P=INTGRL(.  O.PDOT) 

V=1NTGRL(.  O.VDOT) 

R=INTGRL(.  O.RDOT) 

PHI=INTGRL( 0.  0 , P) 

XI=INTGRL(.  0,R) 

DYNAMIC 

IF(U. LT. 20.  3)  LIM=0.  070 
IFCU.GE.  20.  3)  LIM=0.  050 
IF(U.GE.  30.4)  LIM=0.  035 
EKR  =  ORYAW  -  XI 
LERR=  LIMIT( -LIM, LIM, ERR) 

’’'COMPENSATOR  GC11 

LC1A  »  -K1*LERR 
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LC1B  =  LEDLAG( 0.  ,100.  ,10.  ,LC1A) 

DR  ■  REALPL(0.  ,.  667.LC1B) 

DRDEG  =  DR*57.  296 
ROLDEG=  PHI*57. 296 
YAWDEG=  XI*57.  296 
CONTROL  FINTIH=360 
PRINT  1.  ,V, YAWDEG, DRDEG, ROLDEG 
SAVE  0 .  1 , V , YAWDEG , ROLDEG , DRDEG 

GRAPH( DE=TEK6 1 8 )TIHE , YAWDEG , ROLDEG 
LABEL  15  DEGREE  COURSE  CHANGE  U=18  KTS. 

GRAPH( DE=TEK6 1 8 ) TI ME , DRDEG 

LABEL  RUDDER  RESPONSE  TO  15  DEG.  COURSE  CHANGE  U=18  KTS. 
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APPENDIX  II.  SIMULATION  PROGRAM  FOR  NON-LINEAR 
EQUATIONS  OF  MOTION 


*THIS  PROGRAM  SIMULATES  NON-LINEAR  EQUATIONS  OF  MOTION  IN  SIX  DEGREES 
*0F  FREEDOM  FOR  A  SUBMERGED  SUBMARINE 
* 

TITLE  NONLINEAR  SIX  DEGREE  OF  FREEDOM  SUBMARINE  SIMULATION 
PARAM  UC  =  18.  58 
* 

*BALLAST  TANKS  CONTAINS  FOR  DIFFERENT  AXIAL  SPEEDS 

it 

*FOR  5  KTS 
*ARAM  AT  =  -0. 800E-5 
*ARAM  FT  =  0. 800E-5 
*ARAM  AU  =  1.400E-5 
*FOR  6  KTS 
*ARAM  AT  =  -1.03E-5 
*ARAM  FT  =  1.03E-5 
*ARAM  AU  =  2.500E-5 
*FOR  8  KTS 
*ARAM  AT  =  -I.85E-5 
*ARAM  FT  =  1.85E-5 
*ARAM  AU  «  4.50E-5 
*F0R  9  KTS 
*ARAM  AT  =  -2. 35E-5 
*ARAM  FT  =  2. 35E-5 
*ARAM  AU  =  5. 70E-5 
*F0R  10  KTS 
PARAM  AT  =  -2. 85E-5 
PARAM  FT  =  2. 85E-5 
PARAM  AU  =  7.00E-5 
*F0R  12 KTS 

*ARAM  AT  =  -4. 138E-5 
••'•ARAM  FT  =  4.  138E-5 
*ARAM  AU  =  9.77E-5 
*F0R  18KTS 

*ARAH  AT  =  -8.400E-5 
*ARAM  FT  =  8.400E-5 
*ARAM  AU  =  1.80E-4 
*F0R  25KTS 
*ARAM  AT  =  -9. 080E-5 
*ARAM  FT  =  9.080E-5 
*ARAM  AU  =  2. 100E-4 

it 

^PRECALCULATED  COFACTORS 
* 

PARAM  DEL=.  18901E-16,  COFAA=.  212502E-14,  COFAB  =  0.0,  COFAC  =  0.0 

PARAM  COFAD  =  0.0,  COFAE  =  0.0,  COFAF  =  0.0,  COFBA  =  0.0 

PARAM  COFBB=. 153152E- 14,  COFBC=0.  0,  COFBD=-.  186106E-10,  COFBE  =  0.  0 

PARAM  COFBF=.  17543E- 12,  COFCA=0.  0,  COFCB  =  0.  0,  COFCC  =. 11665E-14 
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PARAM  COFCD  =  0.0,  COFCE=-.  999506E-13.COFCF  =  0.0,  COFDA  =  0.0 

PARAM  COFDB=-.  905797E-16,C0FDC=0.  0,  COFDD=.  294191E-11 ,  COFDE  =  0.0 
PARAM  COFDF=-.  224359E-13,C0FEA=0.  0,  COFEB  =  0.0,  COFEC=-.  58035E-18 
PARAM  COFED  =  0.0,  COFEE=.  19562E-13 ,  COFEF  =  0.0,  COFFA  =  0.0 

PARAM  COFFB=. 162929E- 17,  C0FFC=0.  0,  COFFD=-.  318591E-13,  COFFE  =  0.  0 
PARAM  COFFF  =. 179521E-13 

Vr 

*HYDRODYNAMIC  COEFFICIENTS  AND  SUBMARINE  CHARACTERISTICS 

Vr 

PARAM  LC  =  415.0,  ML  =  .0087445,  A1  =  -0.001,  A2  =  -.00095,  A3  =  .00195 
TARAM  IX=7. 3114E-6, IY=5.  6867E-4,  IZ  =  5. 6867E-4 

PARAM  XUDOT  =-.00015,  XVR  =  .011,  XWQ  =  -.0075,  XVV  =  .0065,  XWW  =.002 
PARAM  XDRDR  =-.0028,  XDSDS=-.  0025 ,XDBDB=-.  0026,  XQQ  =-.0002,  XRR=-.  00009 
PARAM  XRP  =  .00025 

PARAM  YVDOT  =-.011,  YWP  =  .  0075,  YV  =-. 021,  YlVlV=-.06,  YR  =  .  003 

PARAM  YV1R1  =-.0073,  YP  =-.  0007 ,YRDOT=.  00009,  YPD0T=-.  0003,  YDR  =.0062 

PARAM  YPQ  =0002,  YWV  =-. 065 

PARAM  ZWDOT  =-.0075,  ZVP  =-.007,  ZS  =-.0001,  ZW  =-.011,  ZW1W1=-.  03 

PARAM  ZVV  =.065,  ZQ  =-.  0045 , ZW1Q1=-. 006 ,  ZVR  =-.  008 ,  ZRR  =-. 0015 

PARAM  ZDS  =-.005,  ZDB  =-.  0025 , ZQDOT=-. 0002,  Z1W1  =  0.0,  ZWW  =0.0 

PARAM  ZRP  =-.0009 

PARAM  KPDOT  =-3.E-6,  KQR  =-.  0001 ,KRD0T=-7. E-6,  KlPlP=-8. E-7 ,  KV  =-.0007 

PARAM  K1V1V  =-.0009,  KP  =-3. 5E-5,  KR  =-4.E-5,  KVDOT=-.  00025, KVW=.  0035 

PARAM  KDR  =7.E-5,  KWP  =  2.5E-4 

PARAM  MODOT  =-.0004,  MRP  =.00015,  MS  =4.E-5,  MW  =.003,  M1W1W=-.005 
PARAM  MW  =.015,  MQ  =-.  0025  ,M1W1Q=-.  002 ,  MVR  =-.  004 ,  MRR=-.  00055 

PARAM  MWDOT  =-.0002,  MDS  =-.0025,  MDB  =.0005,  M1W1  =  0.0,  MVP  =.0009 

PARAM  NRDOT  =-5.E-4,  NPQ  =-4. E-4 ,NPD0T=-7.  E-6 ,  NV  =-.  0075 ,N1V1V=. 014 

PARAM  NR  =-.003,  N1V1R  =-.0045,  NP  =-2.  E-6.NVD0T  =.0003,  NDR  =-.003 

PARAM  NWV  =.015,  NWP  =-. 0002 

PARAM  BZB  =1. 011413E-3 

INCON  YADOT  =  0.0,  RODOT  =  0.0,  PIDOT  =0.0 
INCON  DS  =  0.  0  ,  DB  =  0.  0,  DR  =0.0 
CONTRL  FINTIM=360.  ,DELT=.  01 ,DELS=. 5 
PRINT  1. ,V,YAWGRA,ROLGRA, DEPTH, PITGRA 

Vr 

INITIAL 
LC2 
IZX 
IYX 
IZY 

Vr 

DYNAMIC 

Vf 

*  IF(TIME.  GE.  10)  DR  =0. 611 

*  IF(TIME.  GE.  10)  DB  =0.611 

*  IF(TIME.  GE.  40)  DR  =-0.611 

*  If(TIME.GE.  40)  DB  =-0.611 

*  IF(TIME.GE.  70)  DR  =0.0 

*  IF(TIME.GE.  70)  DB  =0.0 

Vf 

DERIVATIVE 

Vf 

’•'PRECALCULATION  FOR  EQUATIONS  OF  MOTION 

Vf 

PA1  =  XDRDR’"'U’"'U’"'DR*DR  /  LC 


=  LC**2 
=  IZ-IX 
=  IY-IX 
=  IZ-IY 
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PA2  =  XDSDS*U*U*DS*DS/ LC 
PA3  =  XDBDB*U*U*DB*DB/LC 
PB  =  YDR*U*U*DR/LC 
PC2  =  ZDS*U*U*DS/LC 
PC 3  =  ZDB*U*U*DB/LC 
PD  =  KDR*U*U*DR / LC  2 
PE2  =  MDS*U*U*DS/LC2 
PE3  =  MDB*U*U*DB/LC2 
PF  =  NDR*U*U*DR/LC2 
PA  =  PA1  +  PA2  +  PA3 
PC  =  PC 2  +  PC 3 
PE  =  PE 2  +  PE3 
ABV  =  ABS(V) 

ABW  =  ABS(W) 

ABP  =  ABS(P) 

ABQ  =  ABS(Q) 

ABR  =  ABS(R) 

VVWW=  V*V  +  W*W 
AVW  =  SQRT(VVWW) 

ABWP«FCNSW(W,-1.  ,0.  ,1.  ) 

ABVP=FCNSW(V,-1.  ,0.  ,1.  ) 

SA1  =+LC*(XQQ*Q**2  +  XRR*R**2  +  XRP*R*P) 

SA2  =+(ML*V*R  +  XVR*V*R  +  XWQ*W*Q  -ML*W*Q) 

SA3  =+(XVV*V**2  +  XWW*W**2)/LC  -  SIN(PITCH)*(AT+FT+AU) 

SA4  =+( A1*U**2  +  A2*U*UC  +  A3*UC**2)/LC 
SB1  =+LC*YPQ*P*Q 

SB2  =+(YWP*W*P  +  YV1R1*ABR*AVW*ABVP  +ML*W*P  -  ML*U*R) 

SB3  =+(YWV*W*V  +  Y1V1V*AVW*V)/LC  +  SIN(ROLL)*COS( PITCH)*( AT+FT+AU) 
SB4  =(YR*R  +YP*P  +YV*V/LC)*U 
SCI  =  LC*R*( ZRR*R  +  ZRP*P) 

SC2  =+(ZVP*V*P  +  ZVR*V*R  +  ZW1Q1*ABQ*AVW*ABWP  +  ML*U*Q  -  ML*P*V't 
SC3  =+( ZWW*W**2  +  ZVV*V**2  +  ZW1W1*W*AVW  +  U*Z1W1*ABW  +  U*U*ZS)/LC 
SC4  =  ZQ*U*Q  +  ZW*U*W/LC  +  COS( PITCH)*COS( ROLL)*( AT+FT+AU) 

SD1  =+( KQR*Q*R  +  K1P1P*ABP*P)  -  IZY*Q*R 
SD2  =  (KWP*W*P-BZB*SIN(ROLL)*COS( PITCH) )/LC 
SD3  =+( K IV 1 V*V*AVW  +  KVW*V*W  +  KS*U**2)/LC2 
SD4  =  ( ( KP*P  +  KR*R)/LC  +  KV*V/LC2)*U 
SE1  =  (HRP*P  +  MRR*R  +  IZX*P)*R 

SE2  =  ( ( MVR*R  +  MVP*P)*V  +  M1W1Q*AVW*Q  -  BZB*SIN( PITCH) )/LC 

SE3  =(MVV*V**2  +  MWW*W**2  +  H1W1W*AVW*W  +M1W1*U*AVW  +  U**2*MS)/LC2 

SE4  =  MQ*U*Q/LC  +  (MW*U*W  -( 175. 5*FT-219.  5*AT)*C0S( PITCH)*. . . 

C0S(R0LL))/LC2 

SF1  =  (NPQ-IYX)*P*Q 

SF2  =+( NWP*W*P  +  N1V1R*AVW*R)/LC 

SF3  *  (NWV*W  +  N1V1V*AVW)*V/LC2 

SF4  =  (NP*P+NR*R)*U/LC+(NV*U*V+(175.  5*FT-219.  5*AT)*COS( PITCH)*.  . . 
SIN(R0LL))/LC2 


SA 

= 

SA1  +  SA2 

+ 

SA3 

+ 

SA4 

SB 

S 

SB1  +  SB2 

+ 

SB3 

+ 

SB4 

SC 

= 

SCI  +  SC2 

+ 

SC3 

+ 

SC4 

SD 

= 

SD1  +  SD2 

+ 

SD3 

+ 

SD4 

SE 

s 

SE1  +  SE2 

+ 

SE3 

+ 

SE4 

SF 

ss 

SF1  +  SF2 

+ 

SF3 

+ 

SF4 

ZA 

s= 

SA  +  PA 

ZB 

s 

SB  +  PB 

ZC 

= 

SC  +  PC 
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ZD  =  SD  +  PD 

ZE  =  SE  +  PE 

ZF  =  SF  +  PF 

* 

’^EQUATIONS  OF  MOTION 
* 

UDOT  »(COFAA*ZA+COFAB*ZB+COFAC*ZC+COFAB*ZD+COFAE*ZE+COFAF*ZF)/DEI. 
VDOT  =(  COFBA*ZA+COFBB*ZB+COFBC*ZC+COFBD*ZD+COFBE*ZE+COFBF*ZF)  /DEL 
WDOT  =(COFCA*ZA+COFCB*ZB+COFCCvZC-!COFCD*ZD+COFCE*ZE+COFCF*ZF)/DEL 
TDOT  =(COFDA*ZA+COFDB*ZB+COFDC*ZC+COFDD*ZD+COFDE^ZE+COFDF*vZF)/DEL 
QDOT  =(COFEA*ZA+COFEB*ZB+COFEC*ZC+COFED*ZD+COFEE*ZE+COFEF*ZF)/DEI. 
RDOT  =( COFFA*ZA+COFFB*ZB+COFFC*ZC+COFFD*ZD+COFFE*ZE+COFFF*ZF) /DEL 

>Y 

* AUXILARY  EQUATIONS 

it 

ZODOT  =-U*SIN(PITCH)+V*COS(PITCH)*SIN(ROLL)+W*COSCPITCH)*COS(ROLL) 
PIDOT  =  Q*COS( ROLL) -R*SIN( ROLL) 

YADOT  =  (R*COS(ROLL)+Q*SIN( ROLL) )/COS( PITCH) 

RODOT  =  P+YADOT,vS  I  N(  PITCH  ) 

U  =  INTGRL(UC,UDOT) 

V  =  INTGRL(0.  ,VDOT) 

W  =  INTGRLCO.  ,WDOT) 

P  =  INTGRL(0.  ,PDOT) 

Q  =  INTGRLCO.  ,QDOT) 

R  =  INTGRLCO.  ,RDOT) 

DEPTH  =  INTGRLCO.  .ZODOT) 

*  ROLL  =  INTGRLCO.  43633, RODOT) 

ROLL  =  INTGRLCO.  0, RODOT) 

*  PITCH  =  INTGRLCO.  7854, PIDOT) 

PITCH  =  INTGRLCO.  0, PIDOT) 

YAW  =  INTGRLCO.  .YADOT) 

DBGRA  =  DB*57.  296 

DSGRA  =  DS*57.  296 

DRGRA  =  DR*5  7 .  296 

PITGRA=  PITCH*57.  296 
ROLGRA=  ROLL*57.  296 
YAWGRA=  YAW*57.  296 

SAVE  0. 1 , V , DEPTH ,  YAW , P ITGRA , ROLL , ZODOT 
GRAPHC  DE=TEK6 1 8 )TIME , DEPTH , ZODOT , P I TGRA 
LABEL  NI. PITCHO. 04RAD.  U=18. 58  FT/SEC.  NO  PLANES 
GRAPHC  DE=TEK6 1 8 )TIME , ROLL , YAW , V 

LABEL  INI. R0LL=0.  1  RAD.  U=18. 580  FT/SEC.  NO  PLANES 


APPENDIX  I.  COMPENSATED  NON-LINEAR  MODEL 


* 

♦THIS  PROGRAM  SIMULATES  THE  COMPENSATED  NON-LINEAR  SUBMARINE  IN  SIX 
♦DEGREES  OF  FREEDOM 

it 

TITLE  COMPENSATED  NONLINEAR  SIX  DEGREE  OF  FREEDOM  SUBMARINE  SIMULATION 

PARAM  KH  *  1.  00 

PARAM  K1  =  0.  015 

PARAM  K2  *  2.  0 

PARAM  UC  *  18.  69 

♦ARAM  ORYAW=l.  5726 

PARAM  ORYAW=0.  2618 

♦PARAM  ZOR=10. 

PARAM  POR=0.0 
* 

♦BALLAST  TANKS  CONTAINS  FOR  DIFFERENT  AXIAL  SPEEDS 
* 


♦FOR  5  KTS 

♦ARAM  AT  *  -0. 800E-5 

♦ARAM  FT  *  0. 800E-5 

♦ARAM  AU  =  1. 400E-5 

♦FOR  6  KTS 

♦ARAM  AT  =  -1.030E-5 

♦ARAM  FT  *  1. 030E-5 

♦ARAM  AU  *  2. 500E-5 

♦FOR  8  KTS 

♦ARAM  AT  =  -1.85E-5 

♦ARAM  FT  =  1. 85E-5 

♦ARAM  AU  =  4. 5E-5 

♦FOR  9  KTS 

PARAM  AT  =  -2. 35E-5 

PARAM  FT  =  2. 35E-5 

PARAM  AU  =  5. 7E-5 

♦FOR  12 KTS 

♦ARAM  AT  =  -4. 138E-5 

♦ARAM  FT  =  4. 138E-5 

♦ARAM  AU  =  9. 77E-5 

♦FOR  18KTS 

♦ARAM  AT  =  -8.400E-5 

♦ARAM  FT  =  8.400E-5 

♦ARAM  AU  =  1.80E-4 

♦FOR  25KTS 

♦ARAM  AT  =  -9. 080E-5 

♦ARAM  FT  =  9. 080E-5 

♦ARAM  AU  *  2. 100E-4 

it 


♦PRECALCULATED  COFACTORS 
* 

PARAM  DEL=.  18901E-16, 
PARAM  COFAD  =  0.  0 , 

PARAM  COFBB=.  153152E-14, 


COFAA=. 212502E 

-14,  COFAB  =  0.0, 

COFAC  = 

0.  0 

COFAE  *  0.0, 

COFAF  =0.0, 

COFBA  = 

0.  0 

C0FBC=0. 0, 

COFBD=-.  186106E-10, 

COFBE  = 

0.  0 
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PARAM  COFBF=. 17543E-12,  COFCA=0.0,  COFCB  =  0.0,  COFCC  =.  11665E-14 
PARAM  COFCD  =  0.0,  COFCE=-.  999506E-13 ,COFCF  =  0.0,  COFDA  =0.0 

PARAM  COFDB=-.  905797E-16,COFDC=0.  0,  COFDD=. 294191E-11 ,  COFUE  =  0.0 

PARAM  COFDF=-.  224359E-13,COFEA=0.  0,  COFEB  =  0.0,  C0FEC=-. 58035E-18 

PARAM  COFED  =  0.0,  COFEE=.  19562E-13,  COFEF  =  0.0,  COFFA  =  0.0 

PARAM  COFFB=. 162929E-17,  COFFC=0.  0,  COFFD=-. 31B591E-13,  COFFE  =  0.0 
PARAM  COFFF  =. 17952 IE- 13 
* 

’’'HYDRODYNAMIC  COEFFICIENTS  AND  SUBMARINE  CHARACTERISTICS 
* 

PARAM  LC  =  415.0,  ML  =  .0087445,  A1  =  -0.001,  A2  =  -.00095,  A3  =  .00195 
PARAM  IX=7.  3114E-6,IY=5. 6867E-4,  IZ  =  5.  6867E-4 

PARAM  XUDOT  =-.00015,  XVR  =  .011,  XWQ  =  -.0075,  XVV  =  .0065,  XWW  =.002 
PARAM  XDRDR  =-.0028,  XDSDS=-.  0025 ,XDBDB=-.  0026 ,  XQQ  =-.0002,  XRR=-.  00009 
PARAM  XRP  =  . 00025 

PARAM  YVDOT  =-. Oil,  YWP  =  . 0075,  YV  =-.021,  YlVlV=-.06,  YR  =  .  003 

PARAM  YV1R1  =-.0073,  YP  =-.  0007 ,YRDOT=.  00009 ,  YPDOT=-.  0003 ,  YDR  =.0062 

PARAM  YPQ  =.0002,  YWV  =-.  065 

PARAM  ZWDOT  =-.0075,  ZVP  =-.007,  ZS  =-.0001,  ZW  =-.011,  ZWlWl=-.03 

PARAM  ZVV  =.065,  ZQ  =-.  0045, ZW1Q1=-. 006,  ZVR  =-.  008,  ZRR  =-. 0015 

PARAM  ZDS  =-.005,  ZDB  =-.  0025, ZQDOT=-. 0002,  Z1W1  =  0.0,  ZWW  =  0. 0 

PARAM  ZRP  =-.0009 

PARAM  KPDOT  =-3.E-6,  KQR  =-.  0001 ,KRD0T=-7.  E-6,  KlFlP=-8.  E-7 ,  KV  =-.0007 

PARAM  K1V1V  =-.0009,  KP  =-3.5E-5,  KR  =-4. E-5,  KVDOT=-.  00025 ,KVW=.  0035 

PARAM  KDR  =7.  E-5,  KWP  =  2. 5E-4 

PARAM  MQDOT  =-.0004,  MRP  =.00015,  MS  =4. E-5,  MW  =.003,  M1W1W=-.  005 

PARAM  MW  =015,  MQ  =-.  0025 ,M1W1Q=-.  002 ,  MVR  =-.  004,  MRR=-.  00055 

PARAM  MWDOT  =-.0002,  MDS  =-.0025,  MDB  =.0005,  M1W1  =  0.0,  MVP  =.0009 

PARAM  NRDOT  =-5.E-4,  NPQ  =-4.  E-4,NPD0T=-7.  E-6,  NV  =-.  0075 ,N1V1V=.  014 

PARAM  NR  =-.003,  N1V1R  =-.0045,  NP  =-2.  E-6  ,NVD0T  =.0003,  NDR  =-.003 

PARAM  NWV  =.015,  NWP  =-.  0002 

PARAM  BZB  =1. 011413E-3 

INCON  YADOT  =0.0,  RODOT  =  0.0,  PIDOT  =0.0 
INCON  DS  =  0.  0  ,  DB  =  0.0,  DR  =0.0 
CONTRL  FINTIM=360.  ,DELT=.  01 ,DELS=.  5 
PRINT  1.  , YAWDEG , ROLDEG , DEPTH , PITDEG , U 
>v 

INITIAL 

LC2 
IZX 
IYX 
IZY 

Vr 

*ERROR  LIMIT  CALCULATION 

Vr 

DYNAMIC 

IF(U. LT.  15.  )  LIMVER=35. 

IF(U. GE. 15. )  LIMVER  =  25 
IF(U. GE. 25.  )  LIMVER  =  15. 

IF(U.  LT.  20.  3)  LIMHOR=0.  070 
IF(U. GE. 20. 3)  L1MHOR=0.  050 
IF( U. GE. 30. 4)  LIMHOR=0.  035 
HER  =  ORYAW  -  YAW 
ZF.R  =  ZOR  -  DEPTH 
PER  =  POR  -  PITCH 
ZERR=  LIMITC -LIMVER , LIMVER , ZER) 


=  LC**2 
=  IZ-IX 
=  IY-IX 
=  IZ-IY 


HERR=  LIMIT( -LIMHOR,LIMHOR,HER) 

* 

DERIVATIVE 

•it 

*PRECALCULATION  FOR  EQUATIONS  OF  MOTION 
* 

PA1  =  XDRDR*U*U*DR*DR/LC 
PA2  =  XDSDS*U*U*DS*DS/LC 
PA3  =  XDBDB*U*U*DB*DB/LC 
PB  =  YDR*U*U*DR/LC 
PC2  =  ZDS«U*U*DS/LC 
PC3  =  ZDB*U*U*DB/LC 
PD  =  KDR*U*U*DR/LC2 
PE 2  =  MDS*U*U*DS/LC2 
PE3  =  MDB*U*U*DB/LC2 
PF  =  NDR*U*U*DR/LC2 
PA  =  PA1  +  PA2  +  PA3 
PC  =  PC2  +  PC3 
PE  =  PE 2  +  PE3 
ABV  =  ABS(V) 

ABW  =  ABS(W) 

ABP  =  ABS(P) 

ABQ  =  ABS(Q) 

ABR  =  ABS(R) 

VVWW=  V*V  +  tf*W 
AVW  =  SQRT(VVWW) 

ABWP=FCNSW ( W , “ 1 . ,0. ,1. ) 

ABVP=FCNSW(V,-1. ,0. ,1. ) 

SA1  =+LC*(XQQ*Q**2  +  XRR*R**2  +  XRP*R*P) 

SA2  «+(ML*V*R  +  XVR*V*R  +  XWQ*W*Q  -ML*W*Q) 

SA3  =+( XVV*V**2  +  XWW*W**2)/LC  -  SIN(PITCH)*(AT+FT+AU) 

SA4  =+( A1*U**2  +  A2*U*UC  +  A3*UC**2)/LC 
SB1  =+LC*YPQ*P*Q 

SB2  =+(YWP*W*P  +  Y V 1R 1*ABR*A VW* ABVP  +ML*W*P  -  ML*U*R) 

SB3  =+( YWV*W*V  +  Y1V1V*AVW*V)/LC  +  SIN(R0LL)*C0S(PITCH)*( AT+FT+AU) 
SB4  =(YR*R  +YP*P  +YV*V/LC)*U 
SCI  =  LC*R*( ZRR*R  +  ZRP*P) 

SC2  =+(ZVP*V*P  +  ZVR*V*R  +  ZW1Q1*ABQ*AVW*ABWP  +  ML*U*Q  -  ML*P*V) 
SC3  =+(ZWW*W**2  +  ZVV*V**2  +  ZW1W1*W*AVW  +  U*Z1W1*ABW  +  U*U*ZS)/LC 
SC4  =  ZQ*U*Q  +  ZW*U*W/LC  +  COS(PITCH)*COS(ROLL)*( AT+FT+AU) 

SD1  =+( KQR*Q*R  +  K1P1P*ABP*P)  -  I ZY*Q*R 
SD2  =  (KWP*W*P-BZB*SIN(ROLL)*COS( PITCH) )/LC 
SD3  =+( K 1V1V*V*AVW  +  KVW*V*W  +  KS*U**2)/LC2 
SD4  =  ( (KP*P  +  KR*R)/LC  +  KV*V/LC2)*U 
SE1  =  (MRP*P  +  MRR*R  +  IZX*P)*R 

SE2  =  ( ( MVR*R  +  MVP*P)*V  +  M1W1Q*AVW*Q  -  BZB*SIN(PITCH))/LC 

SE3  =(MVV*V**2  +  MWW*W**2  +  M1W1W*AVW*W  +M1W1*U*AW  +  U**2*MS)/LC2 

SE4  =  MQ*U*Q/LC  +  (MW*U*W  -( 175.  5*FT-219.  5*AT)*C0S( PITCH)*. . . 

COS( ROLL) )/LC2 

SF1  =  (NPQ-IYX)*P*Q 

SF2  =+(NWP*W*P  +  N1V1R*AVW*R)/LC 

SF3  *  (NWV*W  +  N1V1V*AVW)*V/LC2 

SF4  =  (NP*P+NR*R)*U/LC+(NV*U*V+( 175. 5*FT-219.  5*AT)*C0S( PITCH)*. . . 

SIN(R0LL))/LC2 

SA  =  SA1  +  SA2  +  SA3  +  SA4 

SB  =  SB1  +  SB2  +  SB3  +  SB4 
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SC 

St 

SCI  +  SC 2 

+  SC  3 

+ 

SC4 

SD 

s 

SD1  +  SD2 

+  SD3 

+ 

SD4 

SE 

= 

SE1  +  SE2 

+  SE3 

+ 

SE4 

SF 

s 

SF1  +  SF2 

+  SF3 

+ 

SF4 

ZA 

= 

SA  +  PA 

ZB 

ss 

SB  +  PB 

ZC 

= 

SC  +  PC 

ZD 

s 

SD  +  PD 

ZE 

s 

SE  +  PE 

ZF 

ss 

SF  +  PF 

’''EQUATIONS  OF  MOTION 
* 

UDOT  =(  COFAA*ZA+COFAB*ZB+COFAC*ZC+COFAD*ZD+COFAE*ZE+COFAF*ZF)  /DEL 
VDOi  =(COFBA’VZA+COFBB*ZB+COFBC’VZC+COFBD’VZD+COFBE'VZE+COFBF’VZF)/DEL 
WDOT  =(  COFCA*ZA+COFCB*ZB+COFCC*ZC+COFCD*ZD+COFCE’>ZE+COFCF*ZF)  /DEL 
PDOT  =(COFDA*ZA+COFDB*ZB+COFDC’VZC+COFDD’VZD+COFDE*ZE+COFDF’VZF)/DEL 
QDOT  =(  COFEA’VZA+COFEB*ZE+COFEC’VZC+COFED*ZD+COFEE*ZE+COFEF’VZF)/DEL 
RDOT  =(COFFA*ZA+COFFB*ZB+COFFC*ZC+COFFD*ZD+COFFE*ZE+COFFF*ZF)/DEL 

* 

*AUXILARY  EQUATIONS 

A 

ZODOT  =-U*SIN(PITCH)+V*COS(PITCH)*SIN(ROLL)+W*COS(PITCH)*COS(ROLL) 

PIDOT  =  Q*COS( ROLL) -R*SIN(  ROLL) 

YADOT  =  (R*COS(ROLL)+Q*SIN( ROLL) )/COS( PITCH) 

RODOT  =  P+YADOT*SIN( PITCH) 

U  =  INTGRL( UC,UDOT) 

V  =  INTGRL(0. ,VDOT) 

W  =  INTGRL(0. ,WDOT) 

>  P  =  INTGRL(0. ,PDOT) 

Q  =  INTGRL( 0.  ,QDOT) 

R  =  INTGRL( 0.  ,RDOT) 

DEPTH  =  INTGRL( 0.0, ZODOT) 

•  ROLL  =  INTGRL(0.  0, RODOT) 

PITCH  =  INTGRL( 0.0, PIDOT) 

YAW  =  INTGRLCO. , YADOT) 

’■'COMPENSATOR  GC11 

Cll  =  -Kl-ZERR 

C12  =  LF.DLAGCO.  ,1.0,0.1,011) 

DB  ■  REALPL(0.  ,. 667, C12) 

A 

*COMPENSATOR  ."22 

C21  =  -K  *PER 

DS  =  RE^PL(0.  ,.667,C21) 

Vf 

’^COMPENSATOR  GC 

Cl  =  -KH*HERR 

C2  =  LEDLAGC  0.  ,100.  ,10.  ,C1) 

DR  =  REALPL(0.  667.C2) 

A 

1  DBDEG  *  DB’V57.  296 

DSDEG  =  DS*57.  296 

DRDEG  =  DR*57.  296 

<  PITDEG=  PITCH*57.  296 

ROLDEG=  ROLL*57.  296 
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YAWDEG*  YAW*57.  296 

SAVE  0 .  1 .  V , 2D0T , DEPTH , PITDEG , ROLDEG , YAWDEG , DRDEG , DSDEG , DBDEG 
GRAPH( DE*TEK6 18)TIME .ROLLDEG , YAWDEG , V 
LABEL  15  DEGREE  COURSE  CHANGE  U*10  KTS. 

*GRAPH(DE»TEK618)TIME , PITDEG .DEPTH , ZDOT 
lVLABEL  10  FEET  DEPTH  CHANGE  U=10  KTS. 
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